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Executive  Summary 


Currently,  the  control  of  the  position  and  orientation  of  the  end-effector  of 
a  robot  manipulator  is  usually  done  by  controlling  the  joint  angles  of  the 
manipulator.  This  approach  suffers  from  load  disturbances,  changes  in 
manipulator  parameters,  and  the  effect  of  compliance.  The  approach  is  an  open- 
loop  control  as  far  as  the  end-effector  is  concerned.  Closed-loop  control  of  the 
end-effector  can  be  achieved  by  using  an  inertial  measuring  system  with  the 
sensors  situated  at  or  near  the  end-effector,  thus  improving  the  overall  system 
accuracy  and  robustness. 

This  report  documents  the  results  of  a  task  to  provide  engineering  support 
for  the  continued  development  of  a  prototype  inertially  aided  robotic  end  effector 
position  determination  system.  This  support  included  the  design  and  fabrication 
of  a  special  data  acquisition  system  (DAS),  analyzing  the  effects  of  system 
parameters  on  position  accuracy,  developing  and  implementing  real-time 
position  determination  software,  and  integrating  hardware  and  software  into  a 
single-axis  robotic  end-effector  position  determination  system. 

The  DAS  was  designed  to  provide  high  resolution  (18  bits  effective,  22  bits 
internal),  high  accuracy,  low  drift  analog-to-digital  conversions  at  up  to  500 
samples/sec.  Software  was  also  developed  to  allow  this  hardware  to  be  used  for 
data  collection. 

A  study  of  position  accuracy  on  system  parameters  such  as 
accelerometer  scale  factor  (SF)  and  bias  stability,  SF  nonlinearity,  filter 
bandwidth,  sampling  rate,  and  resolution  was  also  conducted.  This  study  was 
useful  in  defining  the  parameter  limits  that  are  needed  for  different  applications. 

A  single-axis  position  determination  system  which  consisted  of  1 )  a  Q-flex 
QA2000  accelerometer,  2)  the  DAS,  3)  a  single-axis  linear  translation  table  with 
an  position  encoder  and  4)  real-time  position  determination  software.  The  real¬ 
time  software  was  a  menu  driven  program  that  included  zero  velocity  updates, 
temperature  compensation,  experiments  of  five  different  application  scenarios, 
and  the  capability  of  displaying,  transmitting,  or  storing  the  position  updates  in 
real-time. 

The  test  results  of  the  system  were  below  that  expected  of  the  DAS. 
Therefore,  the  dominant  error  sources  seem  to  reside  in  the  accelerometer.  An 
accelerometer  that  is  specifically  designed  for  this  application  (operation  range  of 
+.  2  Gs)  is  needed.  Also,  from  the  simulation  of  the  DAS,  it  was  determined  that 
20  bits  resolution  is  more  than  needed  and  a  100  Hz  sampling  rate  is  too  slow  for 
real-time  accuracy.  Hence,  using  a  16-bit  converter  to  sample  at  20  kHz  and 
then  averaging  4  samples  resulting  in  a  5  kHz  acceleration  update  should  be 
more  accurate  than  the  current  system  for  real-time  position  accuracies  less  than 
1 0  thousands  of  an  inch.  The  averaging  scheme  will  also  tend  to  increase  the 
effective  resolution  of  the  system.  Before  continuing  any  more  hardware 
development  an  in-depth  simulation  of  the  entire  system  (open  and  closed  loop) 
from  the  accelerometer  to  the  processor  should  be  conducted.  This  approach 
would  better  define  the  propagation  of  error  sources  to  the  position  error. 


1  Introduction 


For  most  of  the  current  robot  manipulators,  control  of  its  end-effector 
position  and  orientation  is  done  by  controlling  joint  angles  as  shown  in  Figure  1 . 
Each  joint  is  controlled  by  a  local  joint  servo.  Angular  position  sensors  are 
installed  at  manipulator  joints  to  measura  joint  angles.  For  a  desired  end-effector 
position  and  orientation,  inyat^e^inematics  is  used  to  generate  command 
signals  in  joint  coordinates  These  signals  become  the  reference  inputs  to 
local  joint  servos.  Such  control  scheme  may  be  called  "joint  sensor  based 
^/nsnipulator  controlj^  Figure  2  shows  a  block  diagram  of  this  control  scheme. 
4Note  tKaratthrragtrlocal  feedback  exists  in  each  joint  servo,  there  is  no  feedback 
to  compare  the  actual  end-effector  state  with  respect  to  the  reference  state. 

End-effector  control  without  feedback  suffers  from  two  major 
shortcomings.  The  first  is  the  effect  of  arm  compliance  on  the  control,  and  the 
second  is  poor  robustness.  The  compliance  is  caused  by  the  physical 
nonrigidness  of  the  manipulator  and  by  the  insufficient  stiffness  of  the  joint 
servos.  The  compliance  effect  causes  two  problems.  The  first  is  the  bending 
and/or  drooping  of  manipulator  arms  caused  by  loading  and  by  the  weight  of 
arms.  This  affects  the  accuracy  of  positioning  the  end-effector.  The  second 
problem  is  the  existence  of  bending  modes  in  the  manipulator’s  dynamical 
characteristics,  making  an  accurate  and  steady  control  of  the  end-effector 
difficult.  Current  methods  to  cope  with  the  problems  of  compliance  is  to  adopt 
large  size  arm  cross-sections,  resulting  in  a  bulky  manipulator^ 

The  lack  of  robustness  is  a  well  known  nature  of  any  System  using  open- 
loop  control.  The  system  is  incapable  of  coping  with  the  load  disturbance  and 
the  changes  in  plant  parameters.  Both  can  be  severe  in  a  manipulator  system. 

Closing  the  end-effect  loop  can  be  done  by  optical  means.  An  optical 
position  monitor  consists  of  one  or  more  cameras  and  an  image  processing 
microcomputer.  A  three-dimensional  picture  of  the  end-effector  is  taken  by 
cameras,  converted  into  digital  data,  and  processed  by  microcomputer  to 
generate  the  command  signal  for  the  manipulator.  This  arrangement  has  its 
drawbacks.  First  of  all,  it  requires  ample  computation  effort,  thus  reducing  the 
bandwidth  of  the  measured  data.  As  a  result,  the  data  may  not  be  useful  for 
bending  mode  control.  Secondly,  there  are  situations  where  uses  of  cameras 
are  not  feasible.  Therefore,  closing  the  end-effect  loop  by  cameras  is  not  always 
an  effective  approach  for  the  improvement  of  manipulator  robustness. 

This  report  documents  the  results  of  a  task  to  provide  engineering  support 
for  the  continued  development  of  a  prototype  inertially  aided  robotic  end  effector 
position  determination  system.  This  support  included  the  design  and  fabrication 
of  a  special  data  acquisition  system  (DAS),  analyzing  the  effects  of  system 
parameters  on  position  accuracy,  developing  and  implementing  real-time 
position  determination  software,  and  integrating  hardware  and  software  into  a 
single-axis  robotic  end-effector  position  determination  system.  The  concept  has 
numerous  advantages  as  compared  to  the  joint  sensor  based  control.  However, 
implementation  of  the  concept  requires  the  solution  of  some  practical  problems. 
The  problems  and  the  attempted  solutions  for  them  will  be  discussed.  Test 
results  will  also  be  presented. 
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Figure  2  -  Block  Diagram  of  Joint  Sensor  Based  Manipulator  Control 
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2  Advantages  of  Inertiaily  Aided  Robotics 


A  concept  has  been  proposed  to  close  the  end-effector  feedback  loop 
using  an  inertial  measurement  system  (IMS)  [3].  An  IMS  consists  of  two  parts, 
an  inertial  measurement  unit  (IMU)  and  a  data  processing  microcomputer.  The 
IMU  is  the  sensor  which  measures  both  the  linear  and  rotational  motions  of  its 
case  while  the  microcomputer  processes  the  IMU  output  data  for  the  state 
(including  position  and  attitude)  of  its  case.  By  mounting  an  IMU  at  or  near  the 
end-effector  of  a  manipulator,  as  shown  in  Figure  3,  the  state  of  the  end-effector 
can  be  determined.  By  comparing  the  actual  end-effector  state  and  the  desired 
state,  errors  are  generated,  which  are  processed  by  microcomputer  to  generate 
the  commands  for  joint  sensors.  In  this  approach,  precision  requirement  for  joint 
sensors,  needed  for  joint  servos,  can  be  greatly  reduced  since  the  error  of  end- 
effector  state  is  sensed  by  the  IMU  and  can  be  made  independent  of  the  errors 
of  joint  sensors.  This  approach  may  be  called  the  "inertial  measurement  (IM) 
based  manipulator  control".  Figure  4  Jepicts  a  block  diagram  of  this  approach. 
Note  that  total  system  feedback  exists  in  the  arrangement,  which  is  markedly 
different  from  the  local  feedback  in  joint  sensor  based  control.  It  is  clear  that  IM 
based  control  is  capable  of  coping  the  effects  of  arm  compliance  and  capable  of 
providing  the  desired  robustness  in  control.  The  advantage  of  IM  based 
manipulator  control  offers  many  practical  features  not  available  from  the  joint 
sensor  based  control.  Some  of  them  are  given  below: 

1.  The  potential  of  handling  ail  problems  caused  by  arm  and  joint 
compliancco.  This  includes  improving  robustness  of  the  system 
with  respect  to  manipulator  loading,  supporting  the  control  of 
bending  modes,  simpler  implementation  of  learning  and  repeating 
procedures,  and  stiffer  end-effector  control. 

2.  Providing  signals  for  the  stabilization  of  the  end-effector  of  a 
manipulator  on  a  moving  platform  (Figure  5).  In  fact,  it  can  support 
the  overall  navigation  of  a  mobile  robot. 

3.  Relaxing  the  need  for  a  complex  analytic  model  of  the  manipulator 
and  enabling  the  use  of  a  simpler  algorithm  for  precision  end- 
effector  control. 

4.  Relaxing  the  precision  requirement  of  joint  sensors. 

5.  Allowing  the  use  of  lighter  arms,  thus  reducing  the  bulk  and  weight 
of  the  manipulator. 

6.  The  potential  of  implementing  a  long  stick  end-effector  for  reaching 
a  distant  point  (Figure  6). 

It  is  clear  that  a  successful  development  of  an  IM  based  control  will  have  a 
significant  impact  on  robot  technology. 
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Figure  4  -  Block  Diagram  of  Inertial  Measurement  Based  Manipulator  Control 
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3  Accelerometer  Characteristics 


3.1  Principle  of  Operation 

A  functional  block  diagram  of  the  QA2000  accelerometer  from  Sunstrand 
Corporation  is  shown  in  Figure  8.  The  flexure  and  proof  mass  are  made  by 
etched  amorphous  quartz.  An  acceleration  applied  parallel  to  the  sensitive  axis 
will  cause  the  proof  mass  to  bend  about  the  flexure.  This  movement  unbalances 
the  inputs  into  the  position  detector  due  to  the  change  in  the  capacitance.  The 
output  of  the  position  detector  then  drives  the  torquer  amplifier  until  the  proof 
mass  has  returned  to  the  null  position.  The  output  of  the  torquer  amplifier  is 
proportional  to  the  input  acceleration  and  is  therefore  use  as  the  output  signal.  A 
simple  resistive  load  can  be  used  to  convert  this  signal  into  a  voltage.  The 
QA2000  package  outline  and  pinout  are  shown  in  Figure  9. 

3.2  QA2000  Performance  Parameters 


The  Q-flex  QA2000  accelerometer  from  Sunstrand  is  capable  of 
measuring  accelerations  up  to  1  kHz  with  minimal  magnitude  and  phase  errors. 
This  fact  can  be  noted  from  the  frequency  response  plot  in  Figure  7.  As  will  be 
discussed  in  the  section  on  system  parameters  it  is  important  to  be  able  to 
measure  the  signal  power  from  dc  to  >  1  kHz  without  degrading  the  magnitude 
and  phase  characteristics.  Therefore  future  designs  should  incorporate  even 
higher  frequency  devices  than  the  QA2000. 

One  of  the  most  important  properties  of  an  accelerometer  for  this  type  of 
application  is  low  noise.  Accelerometer  noise  is  the  dynamically  changing  output 
of  the  accelerometer  that  is  not  related  to  the  actual  input  acceleration.  This 
noise  can  be  measured  using  a  frequency  analyzer  such  as  the  HP3562A  from 
Hewlett  Packard  which  was  used  for  this  task.  The  power  spectrum  (PS)  of  the 
accelerometer  output  without  any  filters  was  measured  for  a  nominal  dc  input 
acceleration  of  0.0.  The  PS  for  two  different  frequency  ranges  is  shown  in 
Figures  10  -  11.  The  two  largest  noise  components  at  27  Hz  and  1 20  Hz  are 
equivalent  to  sinusoidal  accelerations  with  peak  magnitudes  of  98  juG  and  1 1 8 
fjG.  Integrated  twice  these  noise  components  result  in  sinusoidal  position  errors 
with  peak  magnitudes  of  less  than  one  thousandth  of  an  inch.  The  reason  these 
"large”  acceleration  errors  have  a  negligible  effect  on  the  position  error  is  the 
double  integration  effectively  divides  the  magnitude  of  the  noise  components  by 
the  square  of  the  frequency.  Therefore,  the  problem  occurs  for  noise 
components  less  than  1  Hz  which  are  determined  by  the  short-term  bias  and  SF 
stabilities  of  the  accelerometer.  This  problem  is  compounded  by  the  fact  that 
any  noise  components  near  multiples  of  the  sampling  frequency  get  "folded" 
down  near  dc.  (This  phenomenon  is  known  as  aliasing).  Hence,  filters  should 
be  used  to  filter  out  the  frequencies  above  half  the  sampling  rate.  The  total  noise 
power,  which  would  be  the  combination  of  all  frequencies,  can  be  determined  by 
integrating  the  power  spectrum  from  0  to  infinity.  Taking  the  square  root  of  the 
total  noise  power  will  yield  the  rms  value.  The  rms  value  was  approximated  by 
measuring  the  peak  to  peak  value  of  the  output  and  then  dividing  by  6  resulting 
in  1.2  mG  rms.  This  method  of  approximating  the  rms  value  assumes  the 
amplitude  probability  density  function  to  be  Gaussian. 

Table  1  presents  the  typical  performance  parameters  of  an  accelerometer 
for  the  QA2000. 


9 


Table  1  -  QA2000  Typical  Performance  Parameters 


Parameter 

Value 

Scale  Factor  (SF) 
SF  Temp  Coef 

SF  Stability 

1.25  mA/G 
120  PPM/°C 
500  PPM 

Bias  Stability 
Bias  Temp  Coef 

500  }J.G 

30  mG/°C 

Range 

±  25  G 

Misalignment 

2  mrad 

Temp  Range 

-55  to  95°C 
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Figure  8  -  QA2000  Functional  Block  Diagram 
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4  Data  Acquisition  System 


4.1  System  Overview 

A  grs^hical  overview  of  the  data  acquisition  system  (DAS)  is  provided  in 
Figure  12  with  the  supporting  schematics  presented  in  Figures  13-19.  A  wiring 
list  of  the  complete  system  can  be  provided  on  request.  The  system  utilizes  two 
AD1 170  analog-to-digital  convertors  from  Analog  Devices  to  provide  high 
resolution  (up  to  1 8  bits)  sampling  at  rates  up  to  500  Hz.  The  A-to-D  converters 
are  triggered  1 80°  degrees  apart  so  that  the  effective  sampling  rate  is  twice  that 
of  one  convertor. 

The  system  consists  of  four  main  sections,  1 )  the  preamplifier  and  filters, 
2)  the  AD1 170  interface,  3)  the  16-blt  programmable  counter/timer,  and  4)  the 
address  decoder.  The  preamp  and  filters  were  specifically  designed  for  used 
with  the  QA2000  accelerometer.  The  AD1 1 70  interface  allows  for  programming 
the  converters.  The  counter/timer  is  used  to  set  up  a  precise  conversion  timing 
signal  and  the  address  decoder  provides  the  interface  to  an  IBM  PC/XT/AT  or 
compatible.  The  following  four  sections  present  a  detailed  discussion  of  these 
circuits  while  the  last  two  sections  provide  the  component  layouts  and  a  list  of 
system  software. 

4.2  QA2000  Preamplifier  and  Filters 

The  analog  signal  processing  circuits  are  shown  In  Figures  13  and  14.  In 
the  schematic  drawings  the  symbol  used  for  analog  ground  is  a  triangle  while  the 
digital  ground  symbol  was  parallel  lines  in  the  shape  of  a  triangle.  The  current-to- 
voltage  preamplifier  (U26)  has  two  jumper  selectabie  gains  (JMP4)  of  4000  and 
8000  voits/amp  each  with  a  sinole  poie  cutoff  at  3  kHz. 

The  jumper  seiections  JMP1-3  provide  a  dc  offset  for  the  preamp  that  will 
cancel  the  dc  signal  measured  by  the  accelerometer  if  the  sensitive  axis  of  is 
parallel  with  gravity.  This  cancellation  allows  the  QA2000  to  sense  gravity  without 
having  to  increase  the  range  of  the  A-to-D  which  would  decrease  the  resolution 
of  the  system.  A  better  gravity  compensation  scheme  is  shown  in  Rgure  20. 
This  scheme  involves  averaging  the  accelerometer  output  (during  zero  velocity 
update)  and  then  outputting  the  negative  of  this  average  to  a  digital-to-analog 
convertor  to  bias  the  preamp  and  cancel  the  gravity  component.  This  method 
allows  for  any  component  of  gravity  to  be  cancelled  during  normal  robot 
operation. 

Another  amplifier  (U31)  with  a  gain  of  5  volts/volt  was  placed  after  the 
filters  to  allow  for  finer  range  and  resolutions.  A  toggle  switch  (SW2)  on  the  DAS 
box  allows  either  the  QA2000  current  output  to  be  measured  or  an  external 
voltage  signal.  This  external  input  is  not  connected  to  the  preamp  or  filters,  but  it 
is  connected  to  the  x5  amplifier.  Table  2  shows  the  proper  jumper  setting  for 
each  possible  G  range  and  Table  3  provides  the  jumper  selections  for  gravity 
compensation. 
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Two  4-pole  butterworth  filters  (Figure  14)  with  bandwidths  of  40  Hz  and  80 
Hz  were  used  to  filter  out  the  noise  components  of  the  QA2000  above  the  folding 
frequency.  A  magnitude  response  plot  for  each  filter  is  pictured  in  Figure  21  and 
22.  The  two  bandwidths  are  jumper  selectable  as  shown  in  Table  4. 


Table  4  -  Jumper  Selections  for  Filter  Bandwidth 


Filter  BW 

JMP5 

JMP6 

40  Hz 

1-2 

1-2 

80  Hz 

1-3 

1-3 

In  a  digital  sampling  system  the  folding  frequency  is  defined  as  being  half 
the  sampling  frequency  (fs).  Any  frequency  components  of  the  signal  being 
sampled  that  are  above  the  folding  frequency  get  “folded"  down  into  the  range 
between  dc  and  fs/2.  This  phenomenon  is  also  known  as  "aliasing".  Therefore  to 
reduce  the  effects  of  aliasing,  filters  are  placed  before  the  A-to-D  convertor.  The 
selection  of  the  filter  bandwidths  used  in  the  DAS  (40  Hz  and  80  Hz)  were 
selected  for  nominal  sampling  frequencies  of  1 00  Hz  and  200  Hz. 

A  Sallen-Key  active  filter  configuration  was  used  to  implement  the  filters 
discussed  here.  To  insure  that  the  filter  elements  would  not  add  any  noise 
comparable  to  that  of  the  accelerometer,  a  noise  analysis  was  conducted  prior  to 
fabrication.  This  analysis  was  done  for  a  2-pole  filter  without  a  preamp  as  shown 
in  Figure  23.  The  input  to  output  transfer  function  for  this  arrangement  is 

Vput _ H _ 

lin  1  +  sC2(R  +  Ri  +  R2)  +  s^R2C2Ci(R  +  Rj) 

The  current  sources  (except  for  the  input  source)  shown  in  the  figure  are 
actually  white  noise  current  power  models  for  the  resistors  and  the  opamp 
having  units  of  amps^/Hz.  A  simple  nodal  analysis  results  in  the  following 
transfer  functions  for  each  noise  source. 

For  Ri 

Vout  “^^1  Vout 


Iri  K  lin 

For  R2 


Vout  -R2(1  +  sCi(R  +  Ri))  Vout 
^R2  R  ^in 
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For  R 


^out  ^out 


For  En 


Vout 


For In+ 
Vout 


(R  +  Rl  +  R2)(1  +  sCi(R2//(R  +  Ri) )  Vout 


Replacinaj^e  resistor  noise  currents  by  4kT/R  where  k  is  Boltzmann’s  constant 
(1.38x10"'^^  J/^K)  and  T  is  temperature  in  (Jroom  =  300  °K),  results  in  the 
following  equations  for  the  total  input  referred  noise  power, 


in^  =  41cT  [  - 
+  [ 


R  +  Rl  +  R2(1  +  sCi(R  +  Rl)) 


+  En' 


(R  +  Rl  +  R2)2  -  1 

- -  (1  +  sCi{R2//(R  +  Ri))2 


^in 

^out 


and  the  output  referred  noise  power. 


=  I- 


Vout 


]  • 


Substituting  in  the  appropriate  values  for  an  80  Hz  Butterworth  filter  (Table  5)  in 
the  equation  for  the  total  output  power  and  then  integrating  from  dc-infinity  and 
taking  the  square  root  gives  an  rms  output  referred  noise  voltage  of  1.0  (uV. 
Referring  this  value  to  the  input  and  multiplying  by  the  QA2000  scale  factor  (1 .25 
mA/G)  gives  the  input  referred  noise  acceleration  of  0.1  pG,  which  is  negligible 
compared  to  the  accelerometer  noise  1200  juG. 

The  noise  components  of  the  QA2000  are  shown  in  Figures  10  and  1 1  of 
the  previous  section.  Figures  24  -  27  show  the  power  spectrum  of  the 
accelerometer  after  being  filtered.  The  40  Hz  and  80  Hz  filters  reduced  the  RMS 
noise  of  the  QA2000  from  1200  pG  to  75  pG  and  85  /iG  respectively.  The  OP27 
opamp  from  Precision  Monolithics  was  used  in  all  of  the  filter  and  amplifier 
designs  because  of  its  low  noise  characteristics  (3  nV/yHz)  and  bias  stability  (0.4 


^V/month). 

Table  5  -  2-Pole  80  Hz  Butterworth  Filter  Elements 


Element 

Value 

R 

8.0  kn 

Ri 

5.9  kn 

R2 

2.4  kn 

Cl 

0.690  mF 

C2 

0.173  mF 
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Figure  21  -  Magnitude  Response  of  a  40  Hz  4-po!e  Butterworth  Filter 
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Figure  22  -  Magnitude  Response  of  an  80  Hz  4-pole  Butterworth  Filter 
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4.3  AD  11 70  Interface  Circuit 


The  interface  to  the  AD1 170’s  shown  in  Figure  15  was  designed  according 
to  the  requirements  as  specified  in  the  data  sheets  for  these  devices.  A  copy  of 
the  AD1170  data  sheet  is  included  in  Appendix  A.  The  only  deviation  from  the 
data  sheet  was  the  connection  of  the  +5V  reference  of  U1  to  both  reference 
inputs  of  each  device.  This  change  allowed  the  convertors  to  calibrate  using  the 
same  reference  which  should  increase  the  relative  accuracy  of  the  system.  The 
input  impedence  of  the  XTAL  pins  and  the  RESET  pin  did  not  allow  for  combining 
the  crystal  oscillator  circuits  or  the  reset  circuits.  The  external  conversion  signals, 
data  lines,  address  lines,  and  the  read  and  write  strobes  were  all  transmitted  via 
a  DB25  connector  and  cable  (Figure  1 6)  from  the  address  decoder  and  counter 
timer  circuits. 

4.4  Programmable  Counter  Circuit 

The  programmable  counter/timer  (C/T)  consists  of  a  2  MHz  crystal 
oscillator,  16-bit  load  register,  16-bit  counter,  16-bit  counter  latch,  and  a  16-bit 
comparator.  The  outputs  of  the  circuit  are  two  clock  signals,  1 80°  out  of  phase, 
which  are  used  to  trigger  the  start  of  conversion  for  the  two  AD1 1 70’s. 

To  program  the  C/T  for  a  DAS  sampling  frequency  of  fg  the  low  and  high 
bytes  of  the  result. 

Load  value  =  2.0x1  O^/fg  . 

are  written  to  the  16-bit  load  register  (U12  and  U14)  via  the  I/O  bus.  The 
following  "c"  subroutine  can  be  used  to  program  the  counter  for  any  sampling 
rate. 


# define  CNTR_LOW_BYTE  BASE+8 
Idefine  CNTR_HIGH_BYTE  BASE+9 

double  setup_counter  (double  frequency) 
{ 

unsigned  int 

nuinb_counts ,  chigh,  clow; 

double 

actual_freq; 


numb_counts  =  (unsigned  int)  (2 . OE+06/frequency) ; 
chigh  =  {nuinb_counts  »  8)  &  OxOOff; 
clow  =  nunib_counts  &  OxOOff; 

outp  (CNTR_LOW_BYTE,  clow) ; 
outp  (CNTR_HIGH_BYTE,  chigh) ; 

actual_freq  =  2  .  OE+06/ ( (double)  nuinb_counts)  ; 
return  (actual_freq) ; 
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After  the  registers  are  loaded  and  the  start  command  (CNTRW2)  is  given, 
the  2  MHz  clock  (2MCLK)  will  start  incrementing  the  counters  (U9  and  U10).  The 
outputs  of  the  two  8-bit  comparators  (U11  and  U13)  signal  whenever  the  count 
on  the  counters  is  equal  to  the  value  set  in  the  load  register.  The  active  low 
outputs  of  the  comparators  are  "NORed"  to  provide  an  active  high  input  to  an 
edge-triggered  D  flip-flop  (U16A)  which  outputs  a  50%  duty  cycle  clock  (2XCLK) 
at  the  programmed  sampling  rate.  This  dock  is  then  divided  by  2.  using  another 
D  flip-flop  (U7A),  to  provide  the  conversion  trigger  clocks  CNV1\  and  CNV2\. 
Figure  28  shows  the  relative  timing  of  these  signals  as  measured  by  a  logic 
analyzer.  Once  this  process  is  completed  then  the  data  ready  bit  of  one  AD1 1 70 
can  be  monitored  until  it  signals  the  end  of  conversion.  After  reading  this 
AD1 170  then  the  program  can  begin  to  monitor  the  other  AD1170.  The  following 
sample  "c"  program  illustrates  this  procedure.  The  source  code  of  the 
subroutines  used  in  this  program  are  included  in  the  real-time  position 
determination  program  in  Appendix  C. 


#include 
# include 
#include 
# include 
#include 
# include 
# include 
# include 
# include 


<graph.h> 

<string.h> 

<inath.h> 

<stdlib.h> 

<stdio.h> 

<conio.h> 

<tiine.h> 

<bios.h> 

"iarinc.h” 


void 

setup_ADC__defaults  (void)  , 
main  (void) , 
wait_for_A  (void) , 
wait_for_B  (void) ; 

double 

read_A  (void) , 
read_B  (void) , 

setup_ADC_int_tiine  (double  frequency)  , 
setup_counter  (double  frequency) ; 


void  main  () 

{ 

char 

file_name[80] ; 

int 

i; 

double 

sample,  samp_freq,  int_freq; 

FILE 


♦filejptr; 
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/**********************************************************/ 
/*  Open  output  file  */ 

/**■********************************■***★********************/ 


print f  ("XnEnter  name  of  data  file:  '•)  ; 
gets  (file_name) ; 

file_ptr  =  fopen  (file_name,  "w”)  ; 
if  (file_ptr  ==  NULL) 

{ 

printf  (”\n\n\t**  Could  not  open  %s  for  writing  **", 
file_name) ; 

exit(O)  ; 

} 


/**********************************************************/ 
/*  Program  ADC  and  counter/timer  for  sampling  rate  of  */ 

/*  200  Hz  */ 

y**********************************************************/ 

outp  (CNTR_ST0P,  0x0000) ;  /*  Disarm  2MCLK  */ 

setup_ADC_defaults  ()  ; 

samp_freq  =  setup_counter  (200.0); 

int_freq  =  setup__ADC_int_time  (samp_freq)  ; 

outp  (CNTR_START,  0x0000) ;  /*  Arm  2MCLK  */ 


y**********************************************************/ 
/*  Loop  until  2048  samples  have  been  taken  */ 

/**********************************************************y 

for  (i  =  0;  i  <  1024;  ++i) 

{ 

sample  =  read_A  () ; 

fprintf  (file_ptr,  ''\n%g",  sample)  ; 

sample  =  read_B  ( ) ; 

fprintf  (file_ptr,  "\n%g",  sample); 

) 

} 


The  advantage  of  tne  hardware  initiated  conversion  is  that  the  processor 
can  be  used  for  other  task  besides  controlling  the  A-to-D  convertors  and  the 
timing  jitter  is  minimized. 
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4.5  Address  Decoder  Circuit 


The  basic  functions  of  the  address  decoder  circuit  shown  in  Figure  19 
were  to  furnish  chip  select  signals  for  the  two  AD1 170’s,  provide  individual  read 
and  write  signals  for  the  addresses  occupied  by  the  counter/timer,  and  buffer  the 
data  transfers  to  and  from  the  bus.  Connections  to  the  IBM  bus  were  made  such 
that  only  one  TTL  LS  load  needed  to  be  driven  by  the  bus.  Therefore  the  I/O 
read  and  write  strobes,  and  the  address  bits  AO-3  were  buffered  through  a 
74LS244. 

The  switch  (SW1 )  was  used  to  set  the  I/O  base  address  of  the  acquisition 
system.  The  range  of  I/O  base  addresses  is  from  100  to  3F0  (Hexidecimal). 
(That  is  address  bit  A8  is  not  selectable  but  hardwired  to  a  "1“).  Figure  29  shows 
the  address  definitions  for  the  switch.  The  real-time  software  is  setup  to  run  with 
a  base  address  of  380  Hex.  Table  6  shows  the  address  map  of  the  acquisition 
system.  The  last  three  I/O  locations  were  reserved  for  future  enhancements. 


Table  6  -  DAS  Address  Map 


Register/Command 

Read 

Write 

Address 

Data  Lines  Used? 

AD#1  Command  Reg 

* 

Base+0 

Ves 

AD#1  Param  Reg  1 

* 

Base+1 

Yes 

AD#1  Param  Reg  2 

* 

Base+2 

Yes 

AD#1  Status  Reg 

* 

Base-t-0 

Yes 

AD#1  Low  Byte 

* 

Base+1 

Yes 

AD#1  Mid  Byte 

* 

Base+2 

Yes 

AD#1  High  Byte 

* 

Base+3 

Yes 

AD# 2  Command  Reg 

* 

Base+4 

Yes 

AD# 2  Param  Reg  1 

* 

Base+5 

Yes 

AD# 2  Param  Reg  2 

* 

Base+6 

Yes 

AD# 2  Status  Reg 

* 

Base+4 

Yes 

AD# 2  Low  Byte 

* 

Base+5 

Yes 

AD# 2  Mid  Byte 

* 

Base+6 

Yes 

AD# 2  High  Byte 

* 

Base+7 

Yes 

Cntr  Low  Byte 

* 

* 

Base+8 

Yes 

Cntr  High  Byte 

* 

* 

Base+9 

Yes 

Cntr  Start 

* 

Base+10 

No 

Cntr  Stop 

* 

Base+11 

No 

Cntr  Latch  Cnt 

*  Reserved  * 

*  Reserved  * 

*  Reserved  * 

* 

Base+12 
Base+1 3 
Base+14 
Base+15 

No 
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Figure  29  -  Switch  Setting  for  I/O  Base  Address 


The  output  of  the  8-bit  comparator  (74LS682).  which  signaled  when  the 
address  bits  A4-A9  were  equal  to  the  base  address  set  by  the  switch,  was 
"NORed''  with  the  address  enable  strobe  {AEN\)  and  then  inverted  to  provide  the 
enable  signal  for  the  octal  bidirectional  bus  transceiver  (74LS245).  (the  original 
design  used  a  74LS688  which  has  a  built  in  enable  eliminating  the  need  for  U8A 
and  U23D).  The  bus  transceiver  passed  the  data  bits  between  the  bus  and  the 
acquisition  system.  The  direction  of  the  data  transfer  was  controlled  by  the 
buffered  I/O  read  strobe  (BIOR\). 

Using  the  active  low  transceiver  enable  (BASEADD\)  along  with  the 
buffered  address  bits  BA2  and  BAS,  the  chip  selects  for  the  ADl170’s  are 
generated  according  to  the  boolean  equations 


csi\  =  - 

BASEADD\  +  BA2  +  BA3 


and 


CS2\  = 


BASEADD\  +  BA2  +  BA3 

The  lower  8  I/O  locations,  which  are  designated  for  use  with  the 
programmable  counter/timer,  are  decoded  using  two  74LS138  decoders,  one  for 
reading  and  one  for  writing.  The  read  (CNTRRO-7)  and  write  (CNTRWO-7) 
selects  are  active  low  strobes  that  coincide  with  the  I/O  read  and  write  strobes 
(BIOR\  and  BIOW\). 

4.6  Data  Acquisition  System  Component  Layout 

The  DAS  was  physically  divided  into  two  sections.  To  reduce  errors  due 
to  external  noise  sources,  the  preamp,  filters,  and  AD1170  interface  were  placed 
in  a  shielded  enclosure  outside  of  the  main  processing  computer  and  the 
connection  to  the  accelerometer  output  was  via  a  shielded  coaxial  cable.  The  25- 
pin  cable  was  used  to  communicate  with  the  address  decoder  and  counter/timer 
circuits  located  inside  the  microcomputer.  The  component  layouts  for  each 
section  are  pictured  in  Figures  30  and  31 . 
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Figure  31  -  Component  Layout  for  Address  Decoder  and  Counter/Timer 


4.6  Data  Acquisition  System  Software 


During  the  development  of  the  hardware  and  software  for  the  real-time 
position  determination  system,  several  "mini"  programs  were  written  that  are  still 
useful  in  operating  the  DAS  and  Anorad  table.  These  programs  are  listed  in 
Table  7  with  a  brief  description  of  the  program’s  purpose.  The  source  codes 
were  delivered  along  with  the  system  hardware  and  software  and  therefore  are 
not  included  in  this  report. 


Table  7  -  System  Software  List 


Program  Name 

Description 

ANORAD . BAS 

User  friendly  environment  for  controlling 
the  Anorad  linear  translaticn/reference 
table. 

1170SAMP.C 

DAS  data  collection  program.  Variable 
sampling  rate.  Up  to  2048  data  points. 

1170ANO.C 

Same  as  "1170SAMP''  except  it  also  reads 
the  position  of  the  Anorad  table  before 
and  after  sampling  to  determine  total 
distance  moved. 

1170ANOB.C 

Same  as  ''1170ANO.C*'  except  it  also 
commands  the  Anorad  table  to  move.  The 
command  can  be  changed  in  the  program 
and  recompiled  for  different  movements. 

ADCAL.C 

Program  used  to  calibraca  the  AD1170's 
to  an  external  +5V  reference. 

ADSAVE . C 

Program  used  to  save  all  of  the  default 
parameters  of  the  AD1170's  to  nonvolatile 
memory . 

ADRECAL.C 

Recalls  the  last  set  of  saved  AD1170 
parameters . 

AD1170.C 

Uses  the  AD1170's  as  a  simple  digital 
voltmeter . 

1170STOP.C 

Stops  the  conversion  signals  in  the  DAS 
so  that  the  "ADI 170"  program  can  be  used. 
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Table  7  (cont.)  -  DAS  System  Software  List 


Program  Name 


Description 


MULTTRAP.C 


MULTSIMP.C 

MULTADAM.C 


Processes  off-line  data  taken  from  the 
accelerometer.  Compatible  with  "1170ANO" 
and  ''1170ANOB'' .  The  program  compensates 
for  accel  bias  and  then  integrates  twice 
to  determine  position-  The  first  run  in 
a  set  is  used  to  determine  the  scale 
factor.  The  output  of  the  program  is  a 
file  containing  the  velocity  error  and 
position  error  for  each  run.  The  data 
files  in  one  set  should  be  name  with  the 
same  first  six  letters  followed  by  a 
number.  Do  not  use  an  extension, 
ex/  IRUNl ,  1RUN2 ,  1RUN3 , . . . 1RUN9 
This  program  integrates  using  the 
trapezoidal  method. 

Same  as  "MULTTRAP"  except  it  uses  the 
Simpson's  rule  for  integration. 

Same  as  "MULTTRAP"  except  it  uses  the 
Adam-Basforth  method  for  integration. 
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5  Affects  of  System  Parameters  on  Position  Error 


5.1  Data  Acquisition  System  Parameters 

A  computer  simulaiion  was  conducted  to  determine  the  effects  of  the  anti¬ 
aliasing  filter  bandwidth,  the  data  sampling  rate,  and  the  resolution  on  position 
error.  The  simulation  was  programmed  using  a  simulation  environment  called 
SimPack  which  was  developed  by  System  Dynamics  [6].  SimPack  allows  one  to 
simulate  any  system,  linear  or  non-linear,  analog  or  digital.  A  SimPack  user 
develops  the  models  he  needs  and  then  programs  them  in  FORTRAN.  The 
program  used  for  the  DAS  system  is  included  in  Appendix  B. 

The  inputs  to  the  simulation  were  filter  bandwidth,  sampling  rate, 
resolution,  distanced  moved,  and  simulation  minimum  and  maximum  rates. 
Based  on  the  desired  distance  moved  the  program  would  calculate  the 
appropriate  time  intervals  of  a  predefined  acceleration  input.  A  typical 
acceleration  input  is  shown  Figure  32.  The  simulation  did  not  model  any 
accelerometer  errors. 

A  typical  plot  of  the  position  error  versus  time  is  provided  in  Figure  33. 
The  error  grows  during  positive  acceleration  reaching  a  maximum  when  the 
acceleration  turns  negative  and  returning  near  zero  when  the  velocity  returns  to 
zero.  The  fact  that  the  final  error  is  negligible  means  that  the  errors  of  the  DAS 
tend  to  cancel  over  a  movement  that  starts  at  zero  velocity  and  ends  at  zero 
velocity. 

Each  of  the  three  parameters  under  consideration  were  swept 
independently  over  reasonable  ranges.  The  two  parameters  that  were  not  being 
swept  for  a  given  set  were  set  to  default  values  that  would  have  negligible  effects 
on  the  results  as  shown  in  Table  8.  An  execetion  was  the  case  where  the 
sampling  rate  was  swept  in  which  the  filter  bandwidth  was  always  set  to  1/4  of 
the  sampling  rate. 

The  results  are  presented  in  the  form  of  plots  where  the  final  position  error 
and  the  maximum  position  error  are  piotted  versus  the  particular  parameter 
being  swept.  Figures  34  -  36  show  that  the  bandwidth  and  sampling  rate  have  a 
negligible  effect  on  the  final  position  error  while  a  resolution  greater  than  1 4  bits 
will  result  in  a  final  error  less  than  1  thousandth  of  an  inch.  Figures  37  -  39  show 
that  a  resolution  of  at  least  12  bits  will  reduce  the  maximum  error  down  to  10 
thousandths  while  a  sampling  rate  of  than  2  kHz  and  bandwidth  of  1  kHz  is 
required  for  the  same  maximum  error. 

The  results  of  this  simulation  show  that  a  DAS  with  a  higher  sampling  rate 
(4  kHz)  and  lower  resolution  (16-bits)  would  be  more  appropriate  than  the  low 
bandwidth  (100  Hz)  and  high  resolution  (20-bits)  required  in  this  task. 


Table  8  -  Simulation  Defaults 


Parameter 

Variable 

Default 

Filter  Bandwidth 

Fc 

1  kHz 

Sampling  Rate 

Samp_Rate 

4  kHz 

Resolution 

Numb_of_Bits 

32  bits 
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Figure 32 -Typical  Acceleration  Input 


49 


-4.00e+0l 


(S9l[0Ul)  JOJJ3  UOl^lSOJ 


Figure  33  -  A  Typical  Plot  of  Position  Error  versus  Time 
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Figure  34  -  Final  Position  Error  versus  Filter  Bandwidth 
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Figure  36  -  Final  Position  Error  versus  DAS  Resolution 
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Figure  38  -  Maximum  Position  Error  versus  DAS  Sampling  Rate 
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5.2  Inertial  System  Parameters 


The  concept  of  IM  based  manipulator  control  is  very  attractive  based  on 
physical  principles.  However,  the  use  of  IMU  has  its  difficulties  because  of 
sensor  imperfections.  Referring  to  Figure  4,  one  sees  that  the  block  representing 
IMU  is  in  the  feedback  path.  It  is  well  known  in  feedback  control  theory  that  any 
uncertainly  in  a  feedback  element  affects  the  system  output  directly  and  its  effect 
cannot  be  lessened  by  the  use  of  feedback.  Therefore,  finding  ways  to 
sufficiently  reduce  the  uncertainties  in  an  IMU  is  the  key  to  a  successful 
development  of  IM  based  control.  Imperfections  in  an  IMU  mainly  come  from  its 
inertial  sensors,  namely,  accelerometers  and  gyros.  Accelerometers  suffer  from 
bias  uncertainties,  gyros  suffer  from  drift  uncertainties,  and  they  ail  suffer  from 
scale  factor  uncertainties  and  nonlinearities.  These  uncertainties  are  slowly  time 
varying  quantities  in  general,  which  may  become  excessive  over  a  sufficiently 
long  period  of  time. 

5.2.1  Inertial  Bias  Uncertainties 


The  precision  of  commercial  accelerometers  range  from  10  micro-g  to 
1 0,000  micro-g,  where  g  =  9.8  meters/sec,  and  that  of  commercial  gyros  range 
from  .001  degree/hr  to  100  degrees/hr.  Consider  an  IMU  equipped  with  high 
grade  inertial  sensors  having  the  following  uncertainties: 

Accelerometer  bias:  1 0  micro-g 

Gyro  drift:  .01  degree/hr 

Then,  over  an  one  minute  period,  the  accumulated  position  error  is  about  18 
centimeters,  and  the  accumulated  attitude  error  is  about  .6  arcsecond.  The 
position  error  is  not  acceptable  for  most  manipulator  applications.  If  the 
accelerometer  bias  uncertainty  can  be  reduced  to  1  micro-g,  then  the  position 
error  will  be  1 .8  centimeters  which  is  acceptable  for  some  applications.  The  IMU 
imperfection  problem  may  be  solved  by  using  a  certain  novel  reinitialization 
technique  during  the  course  of  manipulator  operation.  It  is  hoped  that  sensor 
uncertainties  will  change  only  slightly  over  a  very  short  period,  say,  a  few 
minutes.  Then,  at  the  end  of  each  short  period,  the  IMU  is  reinitialized  to  reduce 
the  values  of  uncertainties.  By  so  doing,  the  cumulative  errors  of  the  IMU  can  be 
kept  sufficiently  low.  In  the  present  study,  a  robot  manipulator  having  only  one¬ 
dimensional  linear  motion  in  the  horizontal  plane  is  considered.  IM  based  control 
of  such  a  system  requires  only  a  single  accelerometer  as  inertial  sensor. 
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5.3  Numerical  Integration 

A  numerical  integrator  is  needed  to  convert  acceleration  data  to  velocity 
and  position  data.  Since  a  numerical  integrator  is  an  approximation  to  the  ideal 
integrator,  it  causes  errors.  Three  numerical  integrators  are  compared.  The 
three  are  trapezoidal  rule  integrator,  Simpson’s  rule  integrator,  and  Adam- 
Bashforth  integrator.  Their  time  domain  algorithms  and  associated  frequency 
domain  transfer  functions  are  given  in  the  following; 

Trapezoidal  Rule  Integrator 

Algorithm: 

Yk  =  Yk-l  +  (^k  +  x]c-i)*T/2  (1) 

Transfer  function: 

T  (1  +  z~^) 

Ht(z)  =  - ; —  (2) 

2  (1  -  2-1) 

Simpson’s  Rule  Integrator 

Algorithm: 

Yk  =  Yk-l  +  (5Xk  +  8Xk_i  -  X]<;-2)*T/12  (3) 

Transfer  function: 

T  (1  +  4z“i  +  z“2) 

Hs(z)  *  - ; -  (4) 

3  (1  -  z-1) 

Adam-Bashforth  Integrator 

Algorithm: 

Yk  =  Yk-l  + 

(55Xk  -  59X)c-i  +  37Xk-2  "  9x^-3)  *T/24  (5) 
Transfer  function: 

T  (55  -  59Z-1  +  37Z-2  -  9z~^) 

Ha(z)  =  - ^ -  (6) 

24  (1  -  z~^) 


The  comparison  is  done  by  comparing  the  frequency  responses  of  the 
three  numerical  integrators.  The  sampling  frequency  used  in  this  test  in  100 
hertz.  Figure  40  shows  the  magnitude  and  phase  responses  of  the  three 
numerical  integrators  and  the  ideal  integrator.  The  gain  of  Simpson  integrator 
becomes  infinite  at  the  folding  frequency  while  the  gain  of  trapezoidal  integrator 
becomes  zero  at  that  frequency.  These  phenomena  can  be  explained  with  the 
help  of  the  pole-zero  diagrams  of  integrator  transfer  functions  as  shown  in  Figure 
41 .  Notice  that  the  Simpson  integrator  has  a  pole  at  the  folding  frequency,  which 
accounts  for  its  infinite  gain  at  that  frequency.  On  the  other  hand,  the  trapezoidal 
integrator  has  a  zero  at  the  folding  frequency  making  its  gain  zero  there.  All 
three  integrators  have  pole  at  d-c. 

To  further  compare  these  algorithms,  the  time-domain  root-sum-square- 
error  was  calculated  at  different  frequencies  for  a  folding  frequency  of  50  Hz  and 


tabulated  in  Table  9.  This  table  shows  Simpson’s  rule  to  be  the  best  up  to  about 
40  Hz,  the  Trapeziodal  method  is  best  from  40  to  45,  and  the  Adam-Basforth 
algorithm  is  best  from  45  to  50.  Therefore,  if  the  signal  bandwidth  is  below  an 
anti-aliasing  filter  with  a  bandwidth  below  0.4fs,  then  the  Simpson’s  Rule 
integrator  is  the  best. 
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Table  9  -  Time-domain  Comparison  of  Three  Numerical  Integrators 


Frequency  (Hz) 

Root- 
Adam-Bas forth 

-Sum-Square- 

Simpson 

-Error 

Trapezlodal 

5 

0.34199 

0.00006 

0.00321 

10 

0.12252 

0.00047 

0.00646 

15 

0.08159 

0.00160 

0.00976 

20 

0.08683 

0.00382 

0.01318 

25 

0.08266 

0.00368 

0.01673 

30 

0.06578 

0.01379 

0.02048 

35 

0.04446 

0.02422 

0.02449 

40 

0.02896 

0.04495 

0.02883 

45 

0.02848 

0.10783 

0.03362 

50 

0.04502 

0.04502 

0.04502 
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6  Inertial  Error  Compensation  Schemes 


As  discussed  earlier,  the  growth  of  IMS  errors  can  be  contained  by 
frequent  reinitializations  during  the  course  of  manipulator  operation.  Different 
initialization  schemes,  with  different  degrees  of  sophistication,  can  be  devised,  it 
is  assumed  that  the  accelerometer  can  be  modeled  by 

m  =  Ka  +  B  (9) 

where  m  is  the  measured  acceleration,  a  is  the  true  acceleration,  k  is  the  scale 
factor,  and  b  is  the  bias.  The  bias  if  further  modeled  as  a  linear  function  of  time  t 
over  a  short  time  period,  that  is. 


B  =  Bo  +  Bit  (10) 

where  Bq  and  Bi  are  constants.  The  purpose  of  frequent  reinitialization  is  to 
determine  the  parameters  of  the  model  and  make  corrections  for  velocity  and 
position  periodically  (~onc8  a  minute).  In  the  following,  three  reinitialization 
schemes,  with  increasing  degree  of  sophistication,  are  presented. 

6.1  Zero-Velocity  Update 

Zero-velocity  update,  abbreviated  ZUPT  by  the  navigation  profession,  is 
the  simplest  initiation  scheme.  It  provides  information  to  update  only  one 
accelerometer  error  parameter,  usually  the  constant  term  Bq  of  the  bias.  When 
end-effector  stops,  its  true  velocity  is  zero.  Any  nonzero  velocity  computed  from 
accelerometer  output  is  the  velocity  error  Verr  inertial  measurement 

system.  Assume  uncertainties  in  K  and  B  are  negligible,  one  has  the  relationship 

Verr  *  BqT  (11) 

where  t  is  the  time  of  elapse  from  the  previous  initialization.  Thus  Bq  can  be 
computed  from 


Bo  =  Verr/T 


(12) 


With  Bq  known,  the  present  end-effector  position  can  be  corrected  using 

Bnew  ”  Bold  ”  Bot^/4  (13) 

where  Sold  are  end-effector  positions  before  and  after  the  correction, 

respectiv^y.  The  ZUPT  software  based  on  this  principle  is  given  in  the  form  of  a 
computer  flow  chart  shown  in  Figure  42.  Details  in  flow  chart  blocks  are  given 
below. 


Given:  One  base-station,  the  home  station 
N,  the  number  of  motions 

D^,  direction  of  the  k-th  motion,  k=l  to  N 
□k,  distance  for  the  k-th  motion,  k=l  to  N 
B,  the  initial  accelerometer  bias 


63 


Block  1 


Block  2 
Block  3 
Block  4 
Block  5 
Block  6 
Block'  7 


Block  8 
Block  9 


K2F/  the  accelerometer  scale  factor 

Read  initial  reference  position  x^ef (0) • 

Set  initial  lAR  distance  D  (0)=0. 

Set  k=l,  the  first  motion. 

Set  the  total  distance  traveled  D<r=0. 

Set  the  total  computation  time  steps  i'p=0 . 

Set  the  present  computation  time  step  i=l. 

Command  motion  to  start. 

Read  accelerometer  output  data  a(i). 

Integrate  a(i)  to  give  velocity  v(i) . 

Is  D(i)  =  Dk? 

Command  motion  to  stop. 

Compute  accelerometer  bias  uncertainty 

T  =  i  X  at 

Bo=  -V{il 
T 

where  t  is  the  sampling  period.  Update  bias  by 
B  =  B  +  Bo 

Compute  position  correction 

X  =  X  -  ^  BqT^ 

Compute  the  total  time  steps  irp  =  irp  +  i. 

Compute  the  total  distance  D-j  =  D-p  +  D(i). 

Reset  i=0. 

Read  reference  position  Xr-ef(iT)* 

Compute  reference  distance 

Dref  “  ^ref(iT)  “  Xj-gf  (0)  . 

Compute  error  in  lAR  distance  e  =  D(i'p)  -  D^ef- 
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If  the  motion  of  the  end-effector  consists  of  one  or  more  round-trip  stops, 
then  at  each  round-trip  stop  the  true  velocity  is  zero  and  the  true  net  distance  is 
also  zero.  Any  non-zero  values  of  velocity  and  distance,  computed  using 
accelerometer  output,  are  errors.  Let  and  Porr  non-zero  velocity 

and  distance  values  at  the  end  of  a  round-trip,  and  Tet  t  be  the  total  time  for  the 
round-trip.  The  ^err  ®'’®  related  to  the  bias  coefficient  uncertainties 

Bq  and  Bi  through  the  following  equation. 

Verr  =  TBq  +  T^Bi 
2 

(14) 

Perr  = 

2  6 

Solving  the  above  equations  for  Bq  and  Si,  gives 

Bq  =  2.  ^err  "*■  ^,Perr 

(15) 

Bi  =  ^err  “  Perr 

(p^  ipO 

Therefore  two  accelerometer  bias  coefficients  can  be  updated.  Figure  43  is  a 
computer  software  flow  chart  for  the  scheme  of  zero-velocity  update  with  round- 
trip  motion.  Details  in  flow  chart  boxes  are  given  below. 

Given:  One  base-station,  the  home  station 

N,  the  total  number  of  motions 

d^,  the  direction  of  the  k-th  motion,  k=l  to  N. 

Dk,  the  distance  of  the  k-th  motion,  k-1  to  N. 
Accelerometer  bias  B  =  Bq  +  B^t. 

Accelerometer  scale  factor  Kgt- 
Stops  which  are  round-trip  stops. 

Block  1.  Read  initial  reference  position  x^ef (0) • 

Set  initial  distance  D{0)=0. 

Set  motion  number  k=l. 

Set  the  total  distance  traveled  Dt=0. 

Set  the  time  step  count,  for  each  motion,  i-i. 

Set  the  total  time  steps  i'p=  0. 

Block  2.  Command  motion  to  start. 

Block  3.  Read  accelerometer  output  data  a(i). 

Block  4.  Integrate  a(i)  to  give  v(i), 

integrate  v(i)  to  give  D(i). 

Block  5.  Is  D(i)=Dk? 

Block  6.  Command  motion  to  stop. 


Block 


Block 

Block 


Block 

Block 


7.  Is  this  end  of  a  round-trip? 

T  =  ix  t 
Bo  =  y(il 

T 

Update  bias  Bq  =  Bq  +  Bq- 
Compute  position  correction 

X  =  x-^  BqT^ 

Compute  total  time  steps  i^  =  iT  +  i* 
Compute  total  distance  =  D<r  +  D(i)  . 

9a.  Read  reference  position  x^ef(i). 

9b.  Compute  lAR  distance  error 

D  =  D(i)  -  CXref(i)  -  Xref(O) ] 

Compute  accelerometer  bias  coefficients 

Bo  =  -2  V(i)  +  6  D 
T 

Bi  =  _S-V(i)  +  12  D 

rp^  ipO 

Compute 

Bq  =  Bo  -  Bo 
Bi  =  Bi  -  Bi 

iiji  =  iiji  +  i 

D<p  =  D<p  +  D  { i) 

Compute  position  correction 

X  =  Xj-ef 

Reset  i=i. 

10.  Read  reference  position  Xj-ef(ii>). 

11.  Compute  reference  distance 

Dj-0f  =  Xj-Qf(i)  -  Xj-0f(O) 

Compute  error  in  lAR  distance 
E  =  D(iT)  -  Dj-ef 
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This  scheme  posseses  all  the  features  of  previous  schemes  with  the 
addition  that  two  base-stations  are  available,  the  scale  factor  of  the 
accelerometer  can  be  updated  if  the  motion  from  one  base-station  to  the  other  is 
in  all  in  one  direction.  The  distance  traveled  is 

Dtr  =  Xrs2  “  Xrsi  (1®) 

where  Xrc^  and  XRg2  3'’®  positions  of  the  first  and  second  base-stations, 
respective^,  and  d^r  is  the  true  distance  between  the  two  base-stations.  Then 
the  scale  factor  correction  factor  is  given  by 

^8  =  Dtr/Dcotop  (1'7) 

The  updated  scale  factor  is 

Knew  =  ;38Kold  (18) 

The  above  scale  factor  update  procedure  is  used  in  the  real-time  menu 
option  labeled  with  (M1).  The  menu  option  labeled  (M2)  updates  the  scale  factor 
by  averaging  the  above  update  with  the  last  update, 

Knew  =  (/^sKoid  +  Koid)/2  (19) 

Figure  44  Is  the  computer  software  flow  chart  for  this  scheme.  Details  in 
flow  chart  blocks  are  given  below. 

Given;  Two  base-stations,  with  positions  Xrs2  “  Krsi 
N,  the  total  number  of  motions 

dR,  the  direction  of  the  k-th  motion,  k=l  to  N. 

Dr,  the  distance  of  the  k-th  motion,  k-1  to  N. 
which  stops  are  at  base-station 
Accelerometer  bias  B  =  Bq  +  B^t. 

Accelerometer  scale  factor  Kgf 

Block  1.  Read  initial  reference  position  x^-gf  (0)  . 

Set  initial  lAR  distance  D{0)=0. 

Set  initial  position  x(0)  =  Xref (®) • 

Set  motion  number  k=l. 

Set  the  time  step  count,  for  each  motion,  i-i. 

Set  the  total  distance  traveled  0^=0. 

Set  the  total  time  steps  i'p=  0. 

Block  2.  Command  motion  to  start. 

Block  3.  Read  accelerometer  output  data  a(i). 

Block  4.  Integrate  a(i)  to  give  a(i). 

Integrate  v(i)  to  give  D(i) . 


Block  5.  Is  D(i)  =  Dr? 


Block 

Block 

Block 


Block 

Block 

Block 

Block 


6.  Is  this  a  base-station  stop? 

7.  Command  motion  to  stop. 

8.  Compute  bias  uncertainty 

T  =  ix  t 
Bo  =-V(i) 

T 

Compute  updates 

Bq  =  Bq  +  Bq 

iiji  =  iip  +  i 
D<p  =  Dfp  +  B  ( i ) 

Reset  i=0 . 

Compute  position  correction 

X  =  X  -  ^  BqT^ 

9a.  Command  motion  to  stop. 

9b.  Read  reference  position  x^ef (i) . 

10.  Is  this  a  one  way  motion  from  last  base-station? 

11.  Compute  lAR  distance  error 

D  =  D(i)  —  (i)  —  Xj-Qf  (0)  ] 

Compute  bias  coefficients 

Bo  =  2  V(i)  +  6  D 
T 

Bi  =  6_V{i)  +  12  D 

Bq  =  Bo  +  Bq 

Set  i^  =  It  i  3nd  D-p  =  Dp  +  D(i)  . 

Reset  lAR  position  x  (0)  =Xr-ef  (  i)  • 

Reset  initial  reference  position  Xj-gf  (0)  =Xj-ef  ( i)  . 
Reset  i  =  0. 


Block  12.  Same  as  Block  11  with  additional  scale  factor 
update  computations. 

Bsf  =  Actual  distance  between  2  base-stations 

Computed  distance  between  2  base-stations 

Ksf  -  BsfKsf 

Block  13.  Read  reference  position  x  (i) . 

Block  14.  Compute  error  in  lAR  position 

E  =  x(i)  -  Xj-ef(iT) 


Figure  44  -  Block  Diagram  for  Scheme  3 


7  Real-time  Position  Determination  Software 


The  real-time  position  determination  program  is  a  menu  driven 
environment  that  allows  the  user  to  setup  and  test  a  single-axis  inertial 
positioning  system.  The  program  was  written  in  the  “c"  programming  language 
and  compiled  using  the  Microsoft  C  Version  5.1  Optimizing  Compiler.  The 
source  code  is  included  in  Appendix  C.  The  modular  design  of  the  program  will 
allow  a  different  DAS.  translation  table,  or  processing  unit  to  be  used  by  only 
modifying  a  few  subroutines.  A  flow  chart  of  the  program  is  given  in  Figure  45. 

The  main  menu  offers  four  options: 

1)  System  Setup  -  Activates  a  sub-menu  with  choices  to 
calibrate  the  AD1170’s,  calibrate  the  QA2000  scale  factor  and 
bias,  select  one  of  three  integration  methods,  or  change  the 
DAS  sampling  frequency. 

2)  Experiments  -  Activates  a  sub-menu  with  that  allows  the  user 
to  select  from  five  application  scenario  tests.  A  log  file  will 
record  each  test  that  is  run  along  with  the  results. 

3)  Free-Running  Position  Display  -  Uses  the  currently  selected 
sampling  rate,  and  integration  algorithm  along  with  the  last 
updates  of  the  scale  factor  and  bias  to  display  the  real-time 
position  of  the  accelerometer.  The  program  will  capture  any 
key-strokes  and  send  them  to  the  Anorad  table  so  that  the 
accelerometer  can  be  moved.  (Appendix  D  contains  a  brief 
description  of  all  of  the  Anorad  table  commands.)  A  no¬ 
motion  command  signal  can  be  generated  by  pressing  "Z" 
which  will  invoke  a  zero  velocity  update.  To  return  to  the  main 
menu  press 

4)  Quit  -  Quits  the  program. 

The  five  application  scenarios  are  actually  tests  of  the  compensation 
schemes  discussed  in  section  6.  The  tests  are  referred  to  in  the  program  menu 
as; 


1)  Single  Motion  Test  -  Does  not  use  any  compensation.  One 
run  equals  one  3.6  inch  move. 

2)  Multiple  Motion  Test  w/ZUPT  -  Updates  the  accelerometer 
bias  by  simply  averaging  the  output  of  the  accelerometer 
inbetween  movements.  One  run  equals  three  3.6  inch  moves. 
Discussed  in  section  6.1. 

3)  Multiple  Motion  Test  w/ZUPT  &  Unknown  Base  -  Updates 
the  accelerometer  bias  by  using  the  position  error  and  velocity 
error  over  one  run.  One  run  equals  two  3.6  inch  moves  -  one 
forward  and  one  backward.  Discussed  in  section  6.2 

4)  Multiple  Motion  Test  w/ZUPT  &  Known  Base  -  Updates  the 


4)  Multiple  Motion  Test  w/ZUPT  &  Known  Base  -  Updates  the 
accelerometer  bias  by  using  the  position  error  and  velocity 
error  over  one  run.  One  run  equals  two  3.6  inch  moves  -  one 
forward  and  one  backward.  Discussed  in  section  6.2 

5)  Multiple  Motion  Test  w/ZUPT  &  2  Known  Base  (M1)  • 

Updates  the  accelerometer  bias  and  scale  factor  by  using  the 
position  error  and  velocity  emor  over  one  njn.  One  run  equals 
two  3.6  inch  moves  in  the  same  direction.  Discussed  in 
section  6.3 

6)  Multiple  Motion  Test  w/ZUPT  &  2  Known  Base  (M2)  - 
Updates  the  accelerometer  bias  by  using  a  regular  ZUPT  and 
updates  the  scale  factor  using  the  position  error.  One  run 
equals  two  3.6  inch  moves  in  the  same  direction.  Discussed 
in  section  6.3 

The  results  of  each  test  run  along  with  the  statistics  and  experimental 
conditions  for  each  set  or  runs  are  stored  in  a  log  file.  A  plot  of  the  acceleration 
profile  for  the  3.6  inch  movement  used  in  most  of  these  tests  is  shown  in  Figure 
46. 

The  temperature  compensation  was  implemented  implicitly  since  the  bias 
and  scale  factor  (SF)  updates  would  take  into  account  the  variations  due  to 
temperature  changes.  This  implicit  method  is  better  since  the  temperature 
coeffiecients  vary  significantly  from  one  measurment  to  another  as  determined  in 
phase  one  of  this  project. 

The  heart  of  the  real-time  software  is  a  subroutine  called 
"lntegrate_and_move"  which  simultaneously  determines  the  real-time  position 
and  controls  the  Anorad  table.  The  inputs  to  the  routine  are  amount  of  time  to 
determine  position  in  seconds  and  a  character  string  of  Anorad  table  commands, 
while  the  output  is  the  distance  moved  In  inches  after  the  specified  time. 
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Figure  45  (Cent.)  -  Real-time  Position  Determination  Program  Flow  Chart 
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Rgure  46  -  Acceleration  Profile  of  3.6  Inch  Move 


8  System  Tests 


8.1  System  Setup 

The  robot  end-effector  having  one-dimensional  linear  motion  was 
implemented  using  a  linear  motion  table  manufactured  by  Anorad  Corporation, 
Hauppange,  New  York.  The  table  was  equipped  with  a  motion  controller 
confined  in  a  separate  box.  Mounted  on  the  table  is  an  optical  linear  encoder 
which  can  measure  the  position  of  the  table  to  16  microinches.  The  table  is 
maintained  level.  An  accelerometer  is  mounted  on  the  table  with  its  input  axis 
pointed  along  the  direction  of  table  motion.  The  output  of  the  accelerometer 
goes  to  the  DAS  which  contains  interface  electronics,  anti-aliasing  filter,  and  A/D 
converter.  The  output  of  A/D  converter  goes  to  a  microcomputer  (Compaq 
386/25)  which  is  also  connected  to  the  table  controller  via  an  RS232  port.  The 
RS232  cable  connections  are  shown  in  Rgure  47.  Rgure  48  is  a  sketch  of  the 
system  setup. 
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Figure  47  -  Cable  Connections  for  RS232  Communications  with  Anorad  Table 
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MOUNTING  BLOCK  QA2000  ACCELEROMETER 


COMPAQ  386/25 
COMPUTER 

WITH  OTHER  SECTION 
OF  DAS 


Figure  4S  -  Sketch  of  System  Setup 
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8.2  Test  Results 


Using  the  real-time  software  the  system  was  tested  for  each  application 
scenario.  The  single  motion  test,  multiple  motion  test  with  ZUPT,  and  multiple 
motion  test  with  ZUPT  and  two  bases  (M2)  were  the  only  compensation  schemes 
that  provided  any  useful  results.  Table  10  summurizes  the  results  of  these  tests. 
The  scheme  number  in  the  table  is  the  menu  number  as  specified  in  section  6. 
Each  result  in  the  table  represents  the  statistics  of  50  runs  for  a  filter  bandwidth 
of  40  Hz,  an  A-to-D  range  of  1 .0  Gs,  and  the  trapezoidal  integration  method.  The 
log  files  for  the  tests  are  included  in  Appendix  E.  The  compensation  schemes  for 
the  remaining  tests  relied  on  the  accelerometer  bias  to  be  the  dominant  error 
source  and  also  that  the  bias  could  be  modeleled  by 


B  =  Bq  +  Bit  . 


Evidently  the  accelerometer  errors  such  as  SF  stability  and  nonlinearity  are  as 
dominant  as  the  bias. 

Since  the  results  of  these  tests  were  below  that  expected  of  the  DAS,  a 
more  detailed  simulation  of  the  system  including  the  accelerometer  error  sources 
should  be  conducted.  Such  a  simulation  would  be  able  to  determine  system 
performance  for  a  variety  of  accelerometers,  DAS’s,  and  integration  algorithms. 


Table  10  -  Real-Time  Test  Results 


Scheme 

Sampling  Rate 

Max  Err 

Mean  Err 

Stand  Dev 

1 

200  Hz 

0.268 

0.150 

0.055 

2 

200  Hz 

-0.412 

-0.281 

0.049 

6 

200  Hz 

-9.255 

-0.383 

1.617 

6 

200  Hz 

1.328 

0.008 

0.219 

1 

300  Hz 

0.187 

0.061 

0.054 

6 

300  Hz 

-0.583 

-0.012 

0.092 

Position  errors  and  standard  deviation  are  in  inches. 


83 


9  Conclusions  and  Recommendations 


The  test  results  of  the  system  were  below  that  expected  of  the  DAS. 
Therefore,  the  dominant  error  sources  seem  to  reside  in  the  accelerometer.  An 
accelerometer  that  is  specifically  designed  for  this  application  (operation  range  of 
±  2  Gs)  is  needed.  Also,  from  the  simulation  of  the  DAS,  it  was  determined  that 
20  bits  resolution  is  more  than  needed  and  a  1 00  Hz  sampling  rate  is  too  slow  for 
real-time  accuracy.  Hence,  using  a  16-bit  converter  to  sample  at  20  kHz  and 
then  averaging  4  samples  resulting  in  a  5  kHz  acceleration  update  snould  be 
more  accurate  than  the  current  system  for  real-time  position  accuracies  less  than 
1 0  thousands  of  an  inch.  The  averaging  scheme  will  also  tend  to  increase  the 
effective  resolution  of  the  system.  Before  continuing  any  more  hardware 
development  an  in-depth  simulation  of  the  entire  system  (open  and  closed  loop) 
from  the  accelerometer  to  the  processor  should  be  conducted.  This  approach 
would  better  define  the  propagation  of  error  sources  to  the  position  error. 
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Appendix  A  -  AD1 170  Data  Sheet 
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DEVICES 


High  Resolution,  Programmable 
Integrating  A/D  Converter 


FEATURES 
Low  Nonlinoarity; 

Intaqral:  ±0.001% 

Oifforontial:  ±0.00035% 

Micn>computer*8aMd  Design 
Programmable  Integration  Time:  1  to  350ms 
with  Resolution  from  7  to  18  Sits 
Programmable  Output  Data  Format 
Auto-Zeroed  Operation  and  Electronic  Calibration 
(No  External  Trim  Potentiometers) 

Microprocessor  Compatible  Interface 
High  Throughput;  Over  50  Conversions/Second 
for  Line  Cycle  Integration  Period 
High  Normal  Mode  Rejection:  54dB  at  SOHz 
Small  Size:  1.24’ x  2.5’  <  0.55'  max 

APPUCATIONS 
Data  Acquisition  Systems 
Scientific  Instruments 
Medical  Instruments 
Weighing  Systems 
Automatic  Test  Equipment 

GENERAL  DESCREPTION 

The  ADI  170  is  a  high  resolution  integrating  A/D  convener 
intended  for  applicadons  requiring  high  accuracy  and  high 
throughput  at  low  cost.  A  novel  conversion  architecture  provides 
the  user  with  outstanding  iccuiacy,  subiiity  and  ease  of  use. 

The  AO1170  is  a  complete  microcomputer-based  measurement 
subsystem,  composed  of  three  major  dements:  a  highly  precise 
charge  balancing  convener,  a  single  chip  microcomputer,  and  a 
custom  CMOS  controller  chip.  The  .ADI  170  offers  independently 
programmabic  integration  ome  .from  one  miiiisecond  to  350 
milliseconds)  and  dau  format  i  offset  binary  or  two’s  complement, 
from  7  CO  22  bits).  The  convener  is  .Aiily  auto-zeroed  and  exhibits 
a  span  drift  of  only  9ppm/'’C,  assuring  stable,  accurate  readings. 

The  ADI  170  may  be  interfaced  to  any  microcomputer  based 
system  in  a  memory  mapped  or  I/O  mapped  fashion  via  an  8-bit 
data  bus.  The  .ADII70’s  advanced  features  are  coccrolled  by 
simple  commands  sent  to  it  voa  this  bus. 

The  convener  utilizes  surface  mount  tec.hnology  and  is  housed 
in  a  small  1.24'  x  2.5'’  <  0.55"  package.  It  operates  from  rt5Vdc 
and  *  5V'  dc  power. 


PRODUCT  HIGHLIGHTS 

1.  The  .ADU70,  unlike  dual  slope  conveners,  offers  the  user 
the  capability  of  programming  the  integration  time  by  selecting 
one  of  seven  preset  incegradon  periods  or  by  loading  an 
arbitrary  integradon  period  over  the  interface  bus. 

2.  The  AD  11 70  architecture  provides  for  user  programmable 
dau  format  independent  of  the  integradon  time.  AH  dau  is 
computed  to  22-bit  resoludon  and  the  user  may  specify  any 
resoludon  from  7  to  22  bits.  Usable  resoludon  will  typically 
be  limited  to  18-bits  due  to  measurement  and  calibradon 
noise  error. 

3.  Electronic  digital  calibradon  eliminates  the  need  for  trim 
potendometers.  Calibradon  can  be  pertormed  at  anv  time  by 
applying  an  external  reference  volugc  to  the  input  and  invoking 
a  calibradon  command.  The  calibration  data  is  stored  m  an 
internal  aonvolatile  memory  chip. 

4.  Internal  calibradon  cycles  may  be  programmed  to  occur 
whenever  the  convener  is  idle,  assuring  negligible  offset  drift 
and  only  ^ppm/"^  span  drift. 

5.  The  conversion  rate  is  greater  than  50  conversions  per  second 
when  programmed  for  60Hz  line  cycle  integradon.  The 
maximum  conversion  rate  is  greater  than  250  conversions  per 
second,  using  a  one  mllisccond  integration  period. 
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Functional  Block  Diagram 

FACTORY  DEFAULT  SETTINGS 

The  ADllTO’s  internal  nonvolatile  memory  stores  various  A/D 

parameters  as  programmed  by  the  user  (such  as  the  integration 

period,  output  daa  format,  adibradon  coefficient,  etc.)<  The 

ADI  170  is  calibrated  at  the  faaory  with  the  following  default 

settmgs: 

FORMAT :  16-bit,  offset  binary 
DEFAULT  T(int);  16.667  milliseconds 
(code  2) 

DEFAULT  T(cal):  100  milliseconds 
(code  4) 
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AD1170  ARCHITECTURAL  OVERVIEW 
The  ADI  170  is  a  complete  microcomputer-based  measurement 
subsystem,  containing  three  major  elemeno:  a  highly  precise 
charge  balancing  converter,  a  single  chip  microcomputer,  and  a 
custom  CMOS  controller  chip. 

The  heart  of  the  measurement  technique  is  the  charge  balancing 
convener  (essentially  a  voltage  to  frequency  convener).  This 
convener  measures  the  input  signal  by  balancing  a  proportional 
current  against  a  train  of  precisely  controlled  reference  current 
pulses  using  an  integrator.  The  microprocessor,  together  with 
the  counting  and  gating  circuitry  within  the  CMOS  controller 
chip,  measures  the  period  of  the  reference  current  pulses  by 
interpolating  them  using  a  I2MHz  dock  signal.  The  resulting 
data  is  converted  to  binary  representation  by  the  use  of  floating 
point  firmware  routines  within  the  microprocessor. 

When  the  ADI  170  is  triggered  to  perform  a  conversion,  two 
separate  phases  are  performed:  Srst,  an  integration  phase,  where 
the  input  signal  is  actually  measured,  and  then  a  computation 
phase,  where  the  data  from  the  integration  phase  is  processed, 
along  with  both  the  volatile  and  nonvolatile  calibration  data,  and 


Figure  1.  Timing  Diagrams  and  Requirements 

formatted  for  output  as  the  user  desires. 

The  dundon  of  the  iniegradon  phase  can  be  programmed  by 
the  user,  and  may  be  as  short  as  one  millisecond,  or  as  long  as 
3S0  milliseconds.  The  computadon  phase  aisvays  lasts  approxi¬ 
mately  three  milliseconds  and  commences  immediately  after  the 
integradon  phase  is  over.  Therefore,  the  total  conversion  time 
will  equal  the  user  programmed  integrate  time  plus  a  fixed  3 
milliseconds.  Status  signals  are  provided  to  indicate  when  the 
dau  is  ready  and  when  the  converter  may  be  retriggered  for  the 
next  conversion. 

For  maximum  stability,  the  ADI  170  periodically  calibrates  itself 
by  performing  measurements  upon  a  zero  input  signal  and  a 
full-scale  signal  provided  by  the  internal  reference.  This  technique 
cancels  any  drift  within  the  charge  balancing  converter  itself, 
resulting  in  negligible  offset  drift,  and  gain  stability  equal  to 
that  of  the  reference.  Calibradon  cycles  may  be  programmed  to 
take  place  whenever  the  ADI  170  is  idle,  or  they  may  be  invoked 
under  system  control. 
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Im  ADI  170  contains  no  internal  trims;  its  span  accuracy  is 
ctory  calibrated  by  using  the  ECAL  (Electronic  CALibradon) 
Bture.  This  feature  is  a  Srmware  routine  which  measures  an 
lemally  applied  reference  voltage,  compares  it  to  the  internal 
fercnce  voltage,  and  computes  a  span  correcdon  factor  which 
stored  in  nonvolatile  memory.  The  correcdon  factor  is  then 
>plied  to  all  subsequent  measurements,  thereby  compensating 
IT  the  reference  error.  The  ECAL  fimcdon  may  be  invoked  by 
le  user  at  any  dme,  thereby  replacing  the  usual  trim  potendometer 
ith  a  totally  electronic  calibradon  capability. 

fNDERSTANDING  THE  AD1170  SPECmCATIONS 
he  ADI  170,  because  of  its  unique  conversion  technique,  is 
Redded  quite  differendy  &om  more  convendonal  integrating 
mverters.  The  following  secdons  will  help  the  user  to  understand 
here  the  sources  of  error  are,  and  how  to  esnract  the  best 
ossible  performance  from  the  convener. 

liere  are  two  primary  sources  of  error  in  the  ADI  170;  integral 
ionlinearity  of  the  charge  balancing  convener,  which  influences 
11  conversions  equally,  regardless  of  the  integradon  period  and 
alibradon  period;  and  the  noise  error  of  the  measurement/cali- 
•radon  process,  which  is  a  funcdon  of  the  integradon  period 
ind  calibradon  period  as  selected  by  the  user. 

NTEGRAL  NONLINEARITY 

rhe  integral  nonlinearity  of  the  charge  balancing  convener 
CBC)  b  -  lOppm  (±0.001%)  of  Span.  This  speciilcadon  is  an 
’endpoint”  nonlinearity  measurement;  i.e.,  the  typical  deviadon 
teen  from  a  straight  line  drawn  between  the  CBC  output  at  -  5 
roils  and  its  output  at  -k  S  volts.  This  spedflcadon  excludes  any 
gain  or  offset  error. 

If  the  convener  was  externally  calibrated  at  its  end  points  ( -  S 
volts  and  S  volts),  then  the  Integral  nonlinearity  would  also  be 
the  reladve  accuracy  of  the  convener.  This  is  not  the  case  in  the 
ADI  170,  however,  because  calibradon  is  performed  intertully  at 
0  and  +  5  volts,  rather  than  -  5  and  >  S  volts.  This  calibradon 
technique,  superimposed  upon  the  integral  nonlinearity  of  the 
CBC,  results  in  the  curve  shown  in  Figure  2. 


Figure  2.  Relative  Accuracy  and  Integral  Nonlinearity 
when  Calibrated 


As  shown  in  the  diagram,  the  calibradon  technique  tends  to 
exa^erace  the  reladve  error  at  the  negadve  end  of  the  scale,  and 
reduce  the  error  between  0  and  S  volts.  This  characterisdc 
happens  to  be  most  beneficial  when  using  the  ADI  170  in  systems 
where  the  input  comes  from  a  sensor  whose  signal  is  mosdy 
posidve,  such  as  a  thermocouple. 

For  systems  where  the  user  desires  to  minimia  the  reladve 
error  equally  across  the  whole  span  of  the  converter,  it  is  possible 
to  intendonally  introduce  a  span  error  during  the  ECAL  procedure, 
as  shown  in  Figure  3.  This  scheme  sacrifices  posidve  full-scale 
accuracy  in  order  to  minimize  negadve  full  scale  error.  The  net 
result  is  a  reladve  accuacy  equal  to  the  integral  nonlinearity. 

ERROR 


-5  VOLTS  -S  VOLTS 


Figure  3.  Relative  Accuracy  with  Intentional  Span  Error  at 
+  F.S. 

In  both  cases  the  accuracy  of  the  input  offset  (which  is  servo 
controlled)  is  not  compromised. 

MEASUREMENT/CALIBRATION  NOISE 
Measurement  noise  refers  to  the  conversion-to-conversion  uncer¬ 
tainty  caused  either  by  mathemadcal  truncadon  or  device  noise. 

Calibradon  noise  is  actually  the  measurement  noise  resulting 
from  the  calibradon  process.  The  converter  stabilizes  itself  by 
performing  internal  measurements  of  the  reference,  and  of  ground; 
these  measurements  have  the  same  uncertainty  due  to  noise  as 
does  the  normal  measurement  process. 

The  measurement  and  calibradon  noise  error  of  the  AD  1170 
determines  the  differendal  linearity,  or  useable  resoludon,  of  the 
converter.  This  parameter  determines  the  usable  resoludon 
because  it  defines  what  codes  can  be  seen  through  the  noise. 

The  specified  value  is  the  amount  of  error,  in  either  direcdon 
from  the  average  reading,  which  will  not  be  exceeded  for  9S% 
of  all  conversions.  This  parameter,  as  in  all  integrating  converters, 
is  a  funcdon  of  the  integradon  dme;  long  conversions  result  in 
very  high  resoludon,  while  short  conversions  provide  lower 
resoludon.  In  the  ADI  170,  all  internal  compuudons  are  always 
carried  out  to  22-bit  resoludon,  but  useable  resoludon  is  limited 
by  the  peak-to-peak  noise,  as  determined  by  T(cal)  and  T(int). 

The  chart  shown  in  Figure  4,  illustrates  the  typical  peak-to-peak 
noise  (in  ppm  Span)  versus  T(int)  and  T(cal).  These  numbers 
can  be  used  to  indicate  how  much  useable  resoludon  can  be 
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Figure  4.  Typical  Peak-to-Peak  Noise  (in  ppm  Span)  VersusT(int)  and  T(cal) 
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RESET 

A  reset  sequence  must  be  accomplished  after  power-up  and 
before  any  access  to  the  convener.  The  RESET  line  initializes 
the  internal  logic  of  the  ADllTQ.  This  line  may  be  driven  from 
an  external  source,  such  as  may  exist  in  most  computer  based 
systems,  or  it  may  be  connected  to  a  simple  RC  circuit  which 
will  automatically  invoke  a  reset  .«quence  at  power-up.  Figure  5 
illustrates  the  recommended  circuit. 


expected  under  a  given  set  of  operating  conditions.  For  example, 
a  peak-to-peak  noise  of  ±  8ppm  is  approximately  analogous  to  a 
flicker  of  ziO.SLSBat  16  bits  of  resolution.  Under  these  conditions, 
a  user  could  set  the  default  format  for  the  ADI  170  to  16-bit 
resolution,  and  observe  no  more  than  :£  1/2LSB  of  differential 
error.  See  Table  I  for  conversion  of  typical  peak-to-peak  noise 
to  Differential  Nonlinearity  and  Useable  Resolution. 

The  chan  in  Figure  4  may  also  be  used  to  determine  the  minimum 
effective  caiibrauon  time  for  a  specified  integration  period;  the 
noise  contributions  of  both  the  measurement  cycle  and  the 
calibration  cycle  combine  as  the  “root  sum  square”,  and  the 
combined  effect  tends  to  asymptotically  approach  a  baseline 
value  determined  by  the  shorter  of  die  two.  For  i.xample,  a 
T(cal)  greater  than  10  milliseconds  does  little  or  nothing  to 
improve  the  noise  performance  for  conversions  usmg  a  Tfint)  of 
I  millisecond. 


NOISE 
(ppm  Spaa) 

1 

RESOLUTION! 

AT1/2LSB 

DNL ERROR 
(NO.  OF  BITS) 

1 

RESOLUTION 

ATILSB 

DNL ERROR 
(NO.  OF  BITS) 

DIFFERENTIAL 

NONLINEARITY 

tYaSpaa) 

244 

11 

12 

0.024 

122 

12 

13 

0.012 

61 

13 

14 

0.006 

31 

14 

IS 

0.003 

IS 

15 

16  1 

O.OOIS 

8 

16 

1 

0.00076 

4 

17 

18 

0.00038 

2 

18 

19  1 

0.00019 

Table  I.  Conversion  of  Noise  Error  to  DNL  and  Usable 
Resolution 

SIGNAL  INPUT  CONNECTIONS 

The  ADI  170  has  both  a  positive  input  pin  ( IN)  as  well  as  a 
negative  input  pin  ( -  IN),  but  the  ADI  170  input  is  not  a  true 
differential  input.  The  negative  input  pin  is  an  input  used  during 
calibration  cycles  to  establish  the  zero  reference.  In  applications 
with  static  ground  offsets,  the  -IN  pm  may  be  used  as  a  ground 
sense  input,  to  sense  a  signal  reference  point  which  is  offset 
from  analog  common  by  a  small  differential.  Both  the  -  IN  and 
-t-  IN  signals  must  have  a  bias  current  path  back  to  analog  com¬ 
mon.  Figure  5  illustrates  the  proper  use  of  the  input  signal 
connections. 


Figure  5.  Input,  Power,  Reset,  and  Clock  Connections 


When  driving  the  RESET  line  from  an  external  source,  the  line 
must  be  held  high  for  at  least  2  microseconds  after  the  oscillator 
is  running  and  stable  i,  typically  300  microseconds  after  power  is 
applied)  in  order  to  assure  a  proper  reset. 

CLOCK 

The  .\D1170  requires  a  12.\lHz  clock  for  operation.  This  clock 
may  be  supplied  by  connecting  the  XT,\L  OUT  and  XT.-^L  IN 
pins  to  a  12MHz  crystal,  along  with  two  resistors  and  two  capacitors 
as  shown  in  Figure  5. 

The  user  may  also  supply  a  12.V1H2  logic  signal  from  an  external 
source,  such  as  may  be  available  in  the  user’s  system.  In  this 
case,  the  e.xiemal  clock  should  be  applied  to  the  XTAL  IN  pin, 
and  the  XT.\L  OUT  pin  should  remain  unconnected. 
POWERING  THE  .ADIUO 

For  best  performance,  the  user  should  pay  careful  attention  to 
proper  power  supply  bypassing,  as  well  as  grounding.  .Analog 
common  and  digital  common  are  not  connected  internal  to  the 
module,  but  must  be  connected  externally.  Figure  5  illustrates 
the  proper  connection  of  power  and  ground  to  the  .AD  1 170'. 
REFERENCE  CONNECTIONS 

The  internal  -^5  volt  reference  of  the  .AD  1170  is  brought  out  to 
Pin  21  of  the  module;  for  normal  operation,  it  should  be  connected 
to  the  reference  input  (Pin  23). 

An  external  reference  voltage  of  from  4.5  to  5.5  volts  may  be 
applied  to  the  reference  input  (Pin  23),  and  the  reference  output 
may  remain  unconnected.  The  data  will  be  ratiometric  to  that 
reference.  The  input  impedance  of  the  reference  input  is  ap¬ 
proximately  16K  ohms.  The  reference  input  is  not  dynamic;  any 
external  reference  voltage  must  be  an  essentially  static  DC 
signal. 

INTERFACING  TO  THE  AD  1170 

The  .AD  1170  contains  an  eight-bit  microprocessor  compatible 
interface  structure,  including  control  lines.  It  can  be  interfaced 
to  any  microprocessor-based  system  in  either  a  memory  mapped 
or  I/O  mapped  mode,  and  occupies  four  successive  bytes  of 
read/write  address  space,  as  shown  in  Figure  6.' 
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Figure  6.  Control  Functions 

'.Aiiemptin^  to  RE.^D  and  U’RITE  ji  :he  same  rime  RD  and  'X'R  ,et  low 
may  jltcr  'he  vonrenrs  ot  'he  inrernji  nonvolarile  memorv’. 
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"he  ADI  170  is  controlled  by  writing  a  command  into  the  lowest 
yte  of  the  device  image.  Upon  receipt  of  the  command  byte, 
le  BUSY  line  is  set  low,  indicating  that  command  interpretation 
I  in  progress.  The  BUSY  line  returns  high,  following  command 
iterpreution  and  a  command  dependent  execution  time.  This 
ignals  that  the  command  execution  has  been  completed,  and 
nother  command  may  now  be  written.  The  logical  inverse  of 
he  BUSY  line  is  available  in  the  ST.ATUS  byte  for  use  in  polling. 
«  the  section  below  about  THE  STATUS  BYTE. 

IThen  the  command  requires  one  or  two  parameters,  in  addition 
o  the  command  byte,  they  must  be  written  into  the  second  and 
bird  parameter  bytes  of  the  image  before  writing  the  command 
)yte.  This  is  because  writing  the  command  byte  triggers  the 
nicroprocessor  to  begin  command  interpretation. 

•olio wing  the  execution  phase  of  any  command,  the  C.\iD  ERR 
>it  in  the  ST.ATUS  byte  will  indicate  acceptance  or  rejection  of 
he  command.  When  set,  this  bit  indicates  that  there  was  a 
:ontexnial  or  syntactic  error  in  the  command  or  parameters. 

•innversinns  may  he  initiated  either  bv  bus  command,  or  bv  a 
ligh  to  low  transition  of  the  EXT  CC  line*.  Externally  triggered 
tonversions  behave  in  the  same  wav  as  bus  triggered  conversions, 
txcept  that  the  BUSY  line  and  the  BUSY  bit  in  the  status  word 
remain  inactive:  the  end  of  execution  of  e.xtemallv  triggered 
ronversions  must  be  determined  bv  e.\arTunation  of  the  DTA 
RnV  line  nr  the  DTA  RDY  bit  in  the  ST.-\TUS  word. 

FHE  STATUS  BYTE 

Ihe  lowest  readable  byte  of  the  device  image  is  the  ST.ATUS 
ayte;  it  contains  six  bits  of  information  about  the  current  status 
jf  the  AD  1170.  This  byte  may  be  examined  by  the  host  processor 
It  any  time.  The  individual  bits  in  the  status  byte  (see  Figure  7) 
ire  assigned  the  following  functions: 

BITO  The  BUSY  bit  is  an  invened  version  of  the  signal  on  Pin 
7  of  the  module.  When  low,  it  indicates  that  the  AD  1 170 
is  ready  to  receive  a  command.  When  high,  it  indicates 
that  the  .ADI  170  is  busy  executing  the  last  command. 

Any  commands  loaded  while  the  BUSY  signal  is  high  will 
be  ignored. 

3IT1  The  DT.\  RDY  bit  ;aiso  available  on  Pin  10  of  the  module; 
goes  high  to  indicate  that  the  data  from  the  most  recent 
conversion  is  available  in  the  LOW  D.'^T.A,  .MID  DATA, 
and  HIGH  D.'\T.\  registers.  This  bit  is  cleared  at  the 
start  of  the  next  conversion.  It  may  also  be  cleared  by 
executing  an  EOI  command. 

3IT2  The  DATA  SAT  bit  is  set  by  any  conversion  which  is 
saturated,  i.e..  any  conversion  whose  output  data  exceeds 
positive  or  negative  full  scale. 

3IT3  The  C.MD  ERR  bit  indicates  that  the  most  recently  loaded 
command  contained  a  contextual  or  syntactic  error,  or 
was  not  recognized.  It  is  cleared  when  the  next  command 
is  loaded. 

3IT4  The  INT  bit  also  available  on  Pin  1 1  of  the  module)  goes 
high  to  indicate  that  the  input  signal  is  currently  being 
integrated.  It  is  used  in  multiplexed  systems  to  determine 
when  the  input  multiplexer  may  be  switched. 

3IT5  The  PWRUP  bit  also  available  on  Pin  14  of  the  module) 
goes  high  when  the  module  is  powered  up  or  when  the 
RST  command  is  executed.  It  remains  high  until  device 
initializauon  is  complete.  This  signal  is  used  to  indicate 
readiness  of  the  converter  after  system  initialization. 
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Figure  7.  The  Status  Byte 
OUTPUT  DATA  FORMAT 

The  AD  1 170  architecture  allows  a  programmable  dau  format 
independent  of  the  integration  time.  The  user  may  specify  any 
resolution  from  7  to  22  bits,  and  may  specify  either  offset  binary 
coding  or  two’s  complement  coding.  Programming  the  data 
format  is  accomplished  via  the  use  of  the  SDF  command,  using 
the  format  code  described  in  the  table  in  Figure  S  as  the 
PARAMETER  I  value. 
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Figure  8.  Format  Code 


It  should  be  noted  that  the  .\D1 170  computes  ail  data  to  22  bit 
resolution.  However,  not  all  22  bits  are  useable,  since  the  differ¬ 
ential  performance  is  largely  dependent  upon  factors  such  as 
integration  period  and  calibration  period.  The  SDF  command 
simply  serves  to  round  off  the  result  to  the  specified  number  of 
bits.  The  graph  in  Figure  4  can  be  used  to  estimate  the  amount 
of  useable  resolution  achievable  for  a  specified  integration  period 
and  calibration  period. 

The  output  data  is  always  right  justified  within  the  three  output 
bytes  (LOW  DATA,  .MID  DATA,  and  HIGH  DATA..  If  two’s 
complement  format  is  selected,  the  .MSB  of  the  data  is  inverted 
and  extended  all  the  way  to  the  top  of  the  HIGH  D.\T.\  byte. 
For  example,  if  16  bit  two's  complement  format  is  selected,  the 
data  will  appear  in  the  LOW  D.AT.\  and  .MID  D.AT.\  bytes, 
and  the  .MSB  will  be  0  for  positive  inputs."  The  format  is  a 
nonvolatile  parameter;  whenever  an  SAV.-K  command  is  executed, 
the  current  format  will  be  saved  to  nonvolatile  memory,  and 
will  become  the  default  format  upon  powerup. 

^  'n,»  i^inirriiin,  .juinfion  for  EXT  CC  is  one  aiicfosecond.  1 
tSitice  the  sign  is  exrcnded  sU  ihe  way  to  uie  top  ol  che  uppennost  byre,  the 
HIGH  DATA  byte  will  be  filled  with  the  value  of  the  .\tSB. 
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PROGRAMMING  THE  INTEGRATION  PERIOD 
The  key  parameter  of  any  integrating  A/D  convener  is  the 
integration  period.  As  shown  in  Figure  9,  an  integrating  AO 
convener  provides  maximum  normal  mode  rejection  at  those 
frequencies  which  are  integral  multiples  of  1/T(int),  where  T(inO 
is  the  integration  period.  The  most  common  way  to  exploit  this 
characteristic  is  to  set  the  integration  period  equal  to  one  period 
of  the  power  line  frequency  so  that  ac  hum  will  be  rejected. 
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The  duration  of  the  integration  also  affects  the  resulting  resolution 
of  the  data;  long  integration  times  result  in  more  usable  resolution 
than  do  shon  integration  periods. 

The  ADI  170,  unlike  most  dual  slope  conveners,  offers  the  user 
the  capability  of  programming  the  integratioa  time.  This  feature 
can  be  used  to  great  advantage  in  systems  design,  since  the 
integration  time  can  be  optimized  for  differing  system  conditions. 
For  example,  in  systems  whose  inputs  are  severely  polluted  by 
60Hz  noise,  the  user  may  wish  to  program  the  .ADI  170  for  a 
100  millisecond  integration  tune,  which  will  result  in  excellent 
60Hz  normal  mode  reiection.  In  another  application,  a  user  may 
wish  to  scan  a  large  number  of  channels  rapidly,  lookuig  for 
gross  input  changes,  then  slow  down  in  order  to  make  a  high 
resolution  conversion  before  rcsumuig  rapid  scanning. 

The  .ADI  170  offers  the  user  a  number  of  different  ways  to  set 
the  integration  period.  The  simplest  way  is  by  using  the  SDI 
command  to  set  the  default  integration  period  to  one  of  seven 
preset  periods  (1ms,  lOms,  16.66ms,  20ms,  100ms,  166.66ms, 
300ms).  The  first  two  preset  periods  offer  fairly  rapid  scanning 
at  reduced  resolution;  the  other  five  represent  .American  and 
European  tine  voltage  standards  or  multiples  thereof.  For  single 
conversions  without  altering  the  default  integration  time,  the 
CNA’P  command  may  be  used,  which  also  allows  the  selection 
of  one  of  these  seven  preset  periods.  These  preset  periods  and 
their  corresponding  codes  are  listed  in  the  table  of  Figure  10. 

Another  way  in  which  the  integration  period  may  be  programmed 
is  via  the  EIS  command,  which  allows  the  user  to  load  the  extemaily 
definable  period  register  with  a  binary  value'  proportional  to  the 
desired  integration  penod.  Using  this  technique,  the  user  may 
specify  any  period  from  one  millisecond  to  350  milliseconds 
(with  200  microsecond  accuracy).  Access  to  this  user  definable 
period  IS  via  the  SDI  or  CNVP  commands;  the  last  entry  in 
Figure  10  is  used  to  select  the  period  defined  by  the  EIS  or 
ELS  command. 


C, 

c, 

Co 

INTEGRATION  TIME 

NOTES 

L 

L 

L 

1  Millisecond 

L 

L 

H 

10  Milliseconds 

L 

H 

L 

16.667  Milliseconds 

1  eyelets  60Hz 

L 

H 

H 

20  Milliseconds 

1  cycle  (S'  50Hz 

H 

L 

L 

100  Milliseconds 

SO/60HZ 

H 

L 

H 

166.67  Milliseconds 

10  cycles  tS  60Hz 

H 

H 

L 

300  Milliseconds 

50/60HZ 

» 

H 

H 

(See  Note) 

NOTE 

This  code  is  used  for  externally  loaded  integration  times 
(defined  with  the  EIS  Command)  or  externally  measured  times 
(from  the  ELS  Command).  The  value  can  be  anywhere  from 
1  Millisecond  to  350  Milliseconds. 

Figure  10.  Preset  Integration  Periods 

The  third  way  to  set  the  integration  period  is  via  the  external 
line  sampling  feature,  using  the  ELS  command.  This  command 
samples  the  period  of  the  logic  signal  presented  to  the  ELS 
input  pm  i,Pin  12),  and  sets  the  extemaily  definable  period 
register  accordingly.  This  feature  is  most  useful  in  environments 
with  fluctuating  line  frequencies.  By  executing  an  occasional 
ELS  command,  the  converter  effectively  “tracks”  the  line  fre¬ 
quency.  To  use  this  feature,  a  clean,  bounce  free  logic  represen¬ 
tation  of  the  line  frequency  must  be  present  at  the  ELS  input 
during  the  execution  of  the  ELS  command.  Once  having  performed 
the  ELS  command,  the  measured  integration  time  may  be  selected 
using  the  SDI  or  CNVT  commands  along  with  the  (HHH)  code 
from  the  table  in  Figure  10^. 

It  should  be  noted  that  the  actual  integration  period  used  in  the 
measurement  process  is  accurate  to  about  ±  2(X)us,  due  to  the 
limitations  of  the  charge  balancing  convener.  This  is  adequate, 
however,  for  greater  than  50dB  of  normal  mode  rejection  at 
60Hz  when  using  an  integration  period  of  1/60  second.  Even 
greater  normal  mode  rejection  may  be  obtained  when  the  inte¬ 
gration  period  is  a  multiple  of  the  line  frequency  penod. 

CONTROLLING  THE  CALIBRATION  CYCLE 
The  .AD  11 70  achieves  its  exceUent  span  and  offset  stability  by 
calibrating  itself  against  its  internal  reference  voltages.  The  user 
can  control  the  frequency  of  occurrence  for  calibration  cycles 
and  their  duration. 

The  duration  of  the  calibration  cycle  is  an  important  parameter, 
because  it  affects  the  accuracy  of  the  calibration  cycle  itself. 
Errors  in  the  calibration  cycle  appear  in  the  output  data  as 
instantaneous  offset  and  span  errors.  If  automauc  “background” 
calibration  is  enabled,  these  errors  effectively  appear  as  noise. 
Just  as  in  the  case  of  input  conversions,  longer  calibration  times 
result  in  more  accuracy  and  less  noise. 

Of  course  there  may  be  system  applications  where  there  simply 
isn't  sufficient  time  to  perform  a  long  calibration  cycle.  For  this 
reason,  the  .AD1170  offers  the  user  the  abihrv'  to  specify  the 
calibration  period,  using  the  SDC  command. 

'S«c  the  section  titled  "The  .\Dl  170  Command  Set  *  for  the  formula  used  'o 
compute  the  proper  binar>*  value 

^Oution  IS  advised;  if  no  signal  is  present  at  the  ELS  input  when  the  ELs 
command  is  executed,  or  if  the  Signal  is  not  'ATthin  acceptable  frequency 
limits,  fhc  module  mav  "hang‘*  and  require  a  hard'Aore  reset  to  continue 
operation. 


le  argutnenc  for  the  SDC  command  is  the  same  three-bit  code 
is  used  for  the  SDI  and  CNVP  commands.  The  reason  for 
is  is  that  each  calibration  cycle  consists  essentially  of  two 
dinary  conversion  cycles,  performed  upon  the  internal  zero 
d  span  references.  For  example,  if  an  SDC  command  with  an 
gument  of  3  is  executed,  the  default  calibration  time  will 
en  be  approximately  49  milliseconds  (two  conversions  of  20 
illiseconds  plus  approximately  9  milliseconds  for  the  internal 
athemaucs). 

he  user  may  also  disable  or  enable  background  calibration.  In 
rstems  where  the  AD  1170  may  be  periodically  idle,  i.e.,  not 
erfonning  input  conversions,  background  calibration  is  a  good 
mice.  This  mode  is  enabled  with  the.CALEN  command  and 
ill  cause  the  .ADI  170  to  continually  initiate  an  internal  calibration 
Kcle  whenever  the  converter  is  otherwise  unoccupied.  Any 
snversion  commands  received  during  a  cal  cycle  will  cause  that 
al  cycle  to  be  aboned  in  favor  of  the  input  conversion,  thereby 
iving  the  user  priority  over  calibration.  This  mode  of  operation 
t  automatic  and  transparent. 

lie  CALDI  instruction  is  used  to  disable  background  calibration, 
rhen  this  instruction  is  executed,  the  convener  will  be  completely 
die  between  convert  commands,  and  calibration  cycles  wUl  only 
(ccur  when  invoked  by  the  SCAL  command.  This  mode  of 
iperadon  is  best  when  the  user  would  like  to  perform  input 
.•onversions  at  the  maximum  rate,  and/or  when  the  system  affords 
i  specific  convenient  time  to  perform  calibration. 

rhere  are  no  hard  and  fast  rules  about  the  best  way  to  apply  all 
if  this  flexibility,  but  best  performance  will  be  obtained  if  the 
following  points  are  observed: 

•  Ginsult  the  chan  in  Figure  4  to  determine  the  minimum 
effective  calibration  period  for  use  with  a  desired  integration 
period. 

•  Don’t  use  automatic  background  calibration  unless  your  system 
will  allow  the  convener  enough  uninterrupted  time  to  perform 
at  least  one  calibration  cycle.  For  example,  if  you  are  using  a 
calibration  period  code  of  3,  your  system  must  periodically 
allow  at  least  49  milliseconds  without  a  conven  command  or 
calibration  will  not  occur. 

•  Remember  that  the  purpose  of  the  calibration  cycle  is  to 
cancel  the  intrinsic  drift  of  the  charge  balancing  convener 
within  the  .ADI  170  itself.  If  the  convener  is  in  a  stable  envi¬ 
ronment,  calibration  may  be  done  less  frequently.  The  best 
possible  performance  will  be  achieved  in  stable  ambient  tem¬ 
peratures,  where  calibration  is  manually  invoked  by  the  system 
at  relatively  long  intervals,  using  the  longest  allowable  calibration 
time. 

•  Very  short  calibration  times,  although  allowed  by  the  .ADI  170 
firmware,  are  not  especially  useful  because  they  introduce 
more  error  than  they  compensate.  The  only  useful  purpose  of 
very  short  calibration  times  is  in  systems  which  are  operating 
in  rapidly  changing  ambient  temperatures,  and  then  only  for 
relatively  low  resolution  conversions. 

COMPENSATION  OF  EXTERNAL  OFFSETS 

.An  electronic  “nrll”  feature  compensates  for  offset  errors  of 
signal  conditioning  stages  preceding  the  .ADI  170. 

The  null  feature  comprises  three  commands:  NULL  measures 
the  input  signal  .using  the  current  integration  time)  and  stores  it 
in  internal  R-AM;  NULEN  subtracts  the  measured  value  from 
all  subsequent  conversions;  NULDI  cancels  the  NULEN  com¬ 
mand’s  effect. 

The  sum  of  the  offset  value  plus  the  full-scale  input  should  be 
less  than  the  *6  volts  linear  input  range  of  the  .ADI  170.  The 


offset  value  to  be  nulled  should  ideally  be  no  more  than  a  few 
hundred  millivolts  in  amplitude. 

The  NULL  command  does  not  need  to  be  executed  every  time 
the  AD  11 70  is  powered  up.  Since  the  value  measured  by  the 
NULL  command  is  saved  and  restored  by  the  SAVA  and  RES  A 
commands,  the  value  of  the  null  will  be  the  one  saved  during 
the  last  SAVA  command.  Execute  a  NULL  command  only 
when  a  new  null  measurement  is  desired. 

When  NULEN  is  in  effect,  the  length  of  each  conversion  will 
be  extended  by  approximately  700  microseconds. 

ELECTRONIC  CALIBRATION 

The  AD1170  contains  an  Electronic  CALibration  capability, 
which,  along  with  the  internal  nonvolatile  memory  chip,  effectively 
eliminates  the  need  for  trim  potentiometers  of  any  kind.  This 
capability,  abbreviated  as  ECAL,  should  not  be  confused  with 
the  internal  background  calibration  cycles.  ECAL  is  a  completely 
distinct  fimetion  used  to  calibrate  the  .AD  1 170  to  an  external 
reference  standard. 

The  ECAL  function  measures  the  ratio  of  the  internal  reference 
voltage  in  the  module  with  respect  to  an  externally  applied 
reference  voltage.  The  resulting  coefficient  is  applied  to  the 
math  computations  for  all  subsequent  conversions,  effectively 
compensating  the  module  for  absolute  value  errors  in  its  own 
reference.  The  ratio  is  stored  in  random  access  memory  until 
the  user  invokes  a  SAVA  command,  which  will  save  this  coefficient 
(along  with  the  other  nonv’olatile  parameters)  in  the  nonvolatile 
memory  chip.  When  the  module  is  powered  up,  the  previously 
saved  coefficient  is  recalled  from  nonvolatile  memory  and  stored 
in  random  access  memory. 

In  order  to  use  the  ECAL  command,  the  input  to  the  AD  11 70 
must  first  be  presented  with  an  external  -r  5  volt  reference  standard 
such  as  is  usually  found  in  many  calibration  labs.  The  ECAL 
conunand  may  then  be  invoked;  the  external  reference  voltage 
must  remain  at  the  input  until  command  e.xecution  is  complete. 
If  the  calibration  is  to  be  made  nonvolatile,  a  SAVA  command 
must  then  be  invoked.' 

ECAL  may  also  be  used  as  a  means  of  making  limited  ratiometric 
measurements.  For  example,  in  some  applications,  it  may  be 
useful  to  be  able  to  measure  the  output  of  some  transducer  with 
respect  to  its  excitation;  if  the  excitation  can  be  scaled  to  the 
range  of  4.5  to  5.5  volts,  then  it  can  be  used  as  an  excitation  for 
the  ECAL  process.  Having  digitized  the  excitation,  all  subsequent 
conversions  will  be  ratioed  to  the  ECAL  value.  For  example,  if 
an  ECAL  procedure  is  performed  upon  a  4.5  volt  source,  and 
the  converter  subsequently  digitizes  a  2.25  volt  signal,  the  convener 
output  will  be  half  of  full  scale,  or  11000...  (assuming  offset 
binary  coding).  The  convener  can  be  restored  to  absolute  cali¬ 
bration  by  e.xecuting  a  RES  A  command,  which  will  restore  the 
last  nonvolatile  ECAL  coefficient  to  random  access  memory. 

The  user  is  cautioned  that  the  nonvolatile  memory  used  in  the 
ADI  170  has  a  finite  endurance  of  1000  write  cycles  minimum. 
Assuming  that  the  ADI  170  is  calibrated  weekly,  this  implies  a 
device  life  span  of  greater  than  19  years.  Less  frequent  calibrations 
mean  a  proportionately  longer  life  span.  This  means  EC.AL  may 
be  performed  any  number  of  times,  but  the  user  should  limit 
the  number  of  S.AV.A  commands  in  order  to  extend  the  life  span 
of  the  nonvolatile  memory. 
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Since  the  SAV.^  .;ommand  sjves  all  nonvolatile  parameters,  the  user  should 
be  sure  that  the  other  default  parameters,  such  as  integration  time  and  data 
format,  are  set  to  their  desired  values  beiore  S.AV.\  is  invoked. 


NONVOLATILE  MEMORY 

The  internal  nonvolatile  memory  in  the  ADI  170  is  used  to  store 
the  various  nonvolatile  parameters  associated  with  A/O  operation 
(for  example,  the  integration  period,  dau  format,  ECAL  coeffi¬ 
cient,  etc.)> 

In  addition,  ei(^t  16-bit  words  of  the  nonvolatile  memory  are 
made  available  to  the  user  for  general  purpose  use.  They  may 
be  accessed  using  the  RDNV  and  WRNV  commands.  Because 
the  nonvolatile  memory  is  spedfied  for  a  finite  endurance  of 
1000  write  cycles  minimum,  it  is  best  used  for  data  which  does 
not  regularly  need  to  change,  such  as  configtiration  information 
or  system  calibration  parameters. 

FACTORY  DEFAULT  SETTINGS 

The  ADI  170  is  calibrated  at  the  faaory;  the  factory  default 

settings  are: 

Format:  16-bit,  offset  binary 

Default  T(int):  16.667  milliseconds  (code  2) 

Default  T(cal):  100  milliseconds  (code  4) 

THE  AD1170  COMMAND  SET 

The  ADI  170  command  code  set  includes  20  different  functions. 
Some  of  the  commands  require  no  parameters,  while  others 
require  one  or  two  parameters  which  must  be  loaded  into  the 
PARAMETER  1  and  PARAMETER  2  registers  prior  to  loading 
the  command  register.  Some  commands  (for  example,  CNVP) 
have  their  option  parameter  embedded  in  the  lowest  three  bits 
of  the  command  itself. 

The  execution  time  for  any  command  depends  on  the  command. 
Figure  11  is  a  synopsis  of  the  available  commands,  as  well  as 
estimates  of  their  execution  times. 

Each  of  the  commands  described  below  is  preceded  by  an  opcode 
name,  along  with  the  digital  code  (in  binary). 


CALEN _ 10110000 

CALEN  (CALibtadon  ENable)  enables  automatic  background 
calibration  cycling.  In  this  mode,  background  calibration  cycles 
axe  executed  automatically  whenever  the  AD  1170  is  not  otherwise 
occupied.  If  a  command  is  received  during  a  calibration  cycle, 
that  cycle  will  be  aborted  and  the  command  will  be  executed. 

CALDl _ 10111000 

CALDI  (CALibradon  Disable)  disables  auiomadc  background 
calibradon.  .After  executing  this  command,  the  ADI  170  will  be 
completely  idle  between  commands.  While  in  this  state,  a  single 
calibradon  cycle  may  be  invoked  with  the  SCAL  command. 

CNV _ 00001000 

CNV  (CoNVert)  causes  a  single  conversion  to  be  performed, 
using  the  current  default  integradon  time  and  data  format. 

C>fVP _ 00010C;CiCo 

CNVP  (CoNVen  using  specific  Preset  time)  causes  a  single 
conversion  to  be  performed,  using  one  of  the  eight  preset  inte¬ 
gradon  dmes  as  listed  in  Figure  10.  The  default  integradon  dme 
is  not  changed.  The  three  bit  code  for  the  desired  integradon 
dme  is  embedded  in  the  lowest  three  bits  of  the  command  code. 

ECAL _ 00011000 

ECAL  (Electronic  CALibradon)  causes  an  electronic  calibradon 
cycle  to  be  performed.  An  external  S  volt  reference  voltage 
must  be  presented  to  the  input  before  this  command  is  executed, 
and  the  input  must  remain  stable  undl  the  end  of  command 
execudon  is  signaled  by  the  BUSY  line  or  the  BUSY  bit  in  the 
sums  word.  The  calibradon  dau  computed  by  this  command  is 
applied  to  all  subsequent  conversions,  but  is  not  made  nonvolatile 
undl  a  SAVA  command  is  performed. 


MNEMONIC 

FUNCTIONAL  DESCRIPTION 

EXECUTION  TIME 
(APPROX) 

— 

CNV 

Perform  a  Sinqio  Conversion  Using  the  Default  Integration  Time 

TIintI  +  3ms 

CNVP 

Perform  a  Single  Conversion  Using  the  Specified  Integration  Time 

TIintI  4-  3ms 

ELS 

Measure  Period  of  Signal  at  the  ELS  Input 

Z  TIintI  +  ZOms 

ECAL 

Perform  Electronic  CALibration  Routine 

1.S  seconds 

SOI 

Set  Default  Integration  Time  for  Input  Measurements 

tSOps 

SOC 

Set  Default  Calibration  Period 

leOps 

SOF 

Set  Default  Data  Format 

140ps 

RESA 

Restore  All  Nonvolatile  Parameters  from  Memory 

Z.3ms 

SAVA 

Sav«  All  Nonvolatila  Paramaters  to  Memory 

150ms 

WRNV 

Write  a  Word  to  the  User  EEPROM  Area 

ZZms 

RDNV 

Read  a  Word  from  the  User  EEPROM  Area 

SOOus 

EOl 

Clear  the  Data  Ready  Flag 

Z60ps 

SCAL 

Perform  a  Single  Cal  Cycle 

Zx  T(cal)  ♦  9ms 

CALEN 

Enable  Background  Calibration 

300ps 

CALOl 

Disable  Background  Calibration 

310ps 

EIS 

Set  Integration  Time  to  Arbitrary  Value 

130ps 

RST 

Reset  A01 170  to  Power  Up  Conditions 

ZlOms 

NULL 

Measure  the  Offset  Voltage  Value  at  the  AO1170  Input  and  Store 

TIintI  *  3ms 

NULEN 

Subtract  NULL  Measured  Value  from  All  Subsequent  Conversir  ns 

ZSOps 

NULOl 

Cancel  the  Effect  of  the  NULEN  Command 

ZSOps 

HOI _ lOOOtOOO 

EOI  (End  Of  Inteirupt)  dean  the  DTA  RDY  bit  in  the  status 
byte,  as  well  as  the  DTA  ROY  line  (Pin  10).  It  is  provided  as  a 
means  of  dealing  the  interrupt  source  in  systems  which  use  an 
interrupt  upon  data  ready. 

ELS _ 00100000 

ELS  (External  Line  Sample)  measures  the  period  of  the  logic 
signal  applied  to  the  ELS  input  (Pin  12)'.  This  period  is  loaded 
into  the  register  associated  with  the  last  entry  of  the  table  in 
Hgure  10.  Input  convenions  using  thw  measurement  as  the 
integradon  period  may  be  performed  by  invoking  a  OTVP 
command,  or  by  setting  the  default  integradon  period  with  the 
SDI  command.  This  command  is  intended  for  in  environments 
with  varying  line  power  frequency;  periodically  invoking  this 
command  allows  effecdve  tracking  for  improved  normal  mode 
rejecdon. 

EIS _ 00101000 

EIS  (External  Integradon  Set)  is  used  to  establish  an  arbitrary 
integradon  period  from  1  millisecond  to  3S0  milliseconds.  To 
use  this  command,  first  load  the  PARAMETER  1  and  PARAM¬ 
ETER  2  registers  with  the  16-bit  binary  number  N,  which  is 
calculated  using  the  following  expression: 

N  =  2“  -T(int)/21.333E-6 

After  the  low  and  high  bytes  representing  N  are  loaded  into  the 
PARAMETER  1  and  PARAMETER  2  registers  respecdvely, 
exeqite  the  EIS  command.  Once  this  command  is  executed,  the 
externally  loaded  integradon  dme  can  be  used  via  the  CNVP  or 
SDI  commands. 

RESA _ 01101000 

RESA  (REStore  All)  restores  all  configuradon  parameters  (default 
integradon  dme,  default  calibtadon  dme,  dau  format,  EIS/ELS 
period,  NULL  value  and  electronic  calibradon  data)  finm  non¬ 
volatile  memory.  After  executing  this  funcdon,  ail  parameters 
will  be  restored  to  their  Last  value  as  saved  by  the  SAVA  com¬ 
mand. 

SAVA _ 01001000 

SAVA  (SAVe  All)  saves  all  programmable  attributes  (default 
integradon  dme,  default  calibradon  dme,  data  format,  EIS/ELS 
period,  NULL  value  and  electronic  calibradon  data)  into  non¬ 
volatile  memory. 

SDI _ ^ _ OOlllC^CiCo 

SDI  (Set  Default  Integradon  dme)  sets  the  default  integradon 
dme  to  one  of  the  eight  preset  dmes  listed  in  Figure  10.  The 
three-bit  code  for  the  desired  integradon  time  is  embedded  in 
the  lowest  three  bits  of  the  command  code. 

SDF _ OOllOOOO 

SDF  (Set  Default  Format)  sets  the  default  dau  format  according 
to  the  five  bit  code  loaded  into  the  PARAMETER  I  register 
prior  to  execudon  of  this  command.  The  uble  in  Figure  8  illustrates 
the  construcdon  of  the  five  bit  code  according  to  the  desired 
dau  format  and  rcsoluuon. 


SDC _ 01000C?C,C, 

SDC  (Set  Default  Calibradon  dme)  seu  the  default  calibradon 
dme  (Teal)  according  to  the  three  bit  code  embedded  in  the 
lowest  three  biu  of  the  command.  The  calibradon  times  are 
shown  in  Figure  10.  Note  that  the  actual  duradon  of  a  calibradon 
cycle  is  approximately  2  x  T(cal)  +  9  milliseconds. 

VRNV _ lOOllA^AiA, 

WRNV  (WRite  Nonvolatile)  writes  the  user  supplied  dau,  in 
the  PARAMETER  1  and  PARAMETER  2  registers,  into  the 
user  accessible  area  of  the  ADllTO’s  nonvolatile  memory.  Eight 
words  of  this  memory  are  available,  and  are  addressed  by  the 
lowest  three  bits  of  the  command. 

RDNV _ 10100A?Ai.Ao 

RDNV  vReaD  Nonvolatile)  reads  one  word  from  the  user  ac¬ 
cessible  pordon  of  the  nonvolatile  memory  within  the  .ADI  170, 
and  places  the  dau  into  the  LOW  DATA  and  MID  DATA 
registers  for  retrieval  by  the  user.  The  address  of  the  desired 
word  is  embedded  into  the  lowest  three  bits  of  the  command. 

RST _ 10010000 

RST  (ReSeT)  is  effeedvely  equivalent  to  a  hardware  reset  of  the 
ADI  170.  After  executing  this  command,  all  nonvolatile  parameters 
(including  the  ECAL  coefficient,  the  default  integradon  and 
calibradon  periods,  EIS/ELS  period,  NULL  value  and  the 
default  format)  will  be  restored  to  their  last  saved  values,  automadc 
calibradon  will  be  enabled,  and  NULL  will  be  disabled. 

NULL _ 01110000 

NULL  measures  the  input  signal  (using  the  curent  integradon 
dme  value)  and  stores  the  measurement  in  internal  RAM.  It 
allows  the  user  to  esublish  the  value  of  offset  voluge  at  the 
input  and  subtraa  that  offset  from  subsequent  conversions 
through  the  execudon  of  the  NULEN  command.  The  user  must 
insure  that  the  sum  of  the  offset  value  plus  the  full  scale  input 
is  less  than  the  ±6  volts  linear  input  range  of  the  AD  11 70. 
Ideally  the  offset  value  to  be  nulled  should  be  no  more  than  a 
few  hundred  millivolts  in  amplitude.  The  value  measured  by  the 
NULL  command  is  saved  and  restored  by  the  SAVA  and  RESA 
commands  -  maintaining  this  value  through  subsequent  powerups. 
The  NULL  command  need  only  be  invoked  when  a  new  null 
measurement  is  desired. 

NULEN _ 01111000 

NULEN  (NULl  ENable)  subtracts  the  value,  measured  and 
stored  by  the  last  NULL  command,  from  all  subsequent  con¬ 
versions.  When  NULEN  is  in  effect,  each  conversion’s  length 
will  be  extended  by  approximately  700  microseconds. 

NULDI _ 10000000 

NULDI  (NULl  Disable)  cancels  the  effect  of  the  NULEN 
command. 


SCAL _ 11000000 

SCAL  (Single  CALibradon)  performs  a  single  background  cali- 
bradon  cycle.  This  command  is  intended  for  use  when  auto¬ 
madc  background  calibradon  has  been  disabled  via  the  CALOI 
command. 


'This  logic  signal  should  be  a  TTL  or  CMOS  compadble  coadnuous 
wavefonn.  It  aeed  not  be  symmetrical,  but  the  HIGH  or  LOW  dme  should 
not  be  less  than  2S  microseconds. 
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DM  PC*  INTERFACE 

Figure  12  is  an  example  of  an  ADI  170/IBM  interface  suiuble 
for  the  IBM  PC  or  XT  personal  computers.  In  this  case,  the 
AO  1170  is  interfaced  in  the  I/O  space;  the  DIP  switch  controls 
the  specific  location  of  the  ADI  170  within  the  available  address 
space. 


INTERF.ACING  TO  .AN  8051  .VUCROCONTROLLER 
Figure  13  shows  how  an  ADI  170  may  be  interfaced  (o  an  3051 
microcontroller  using  a  technique  commonly  called  "byte  bang¬ 
ing’*,  where  the  control  lines  and  data  bus  of  a  device  are  man¬ 
ipulated  under  firmware  control.  This  "byte  banging”  technique 
can  be  adapted  to  most  microprocessors  and  is  useful  in  situations 
where  a  conventional  bus  structure  is  either  none.xistent  or 
muvailabie  for  use. ' 

The  ADI  170’s  data  bus  is  connected  to  the  8051  using  1,0  lines 
P2.0  through  P2.7.  The  address  lines  .AO  and  .A1  are  connected 
to  I/O  lines  Pl.O  and  Pl.l  respectively.  The  RD/  and  WR,  lines 
are  connected  to  PI. 2  and  PI. 3.  The  CS/  line  of  the  .AD1170  is 
grounded  when  it  is  the  only  device  connected  to  the  8051,  but 
multiple  .ADI  170s  could  easily  be  connected  in  the  same  way  if 
each  CS/  line  were  separately  controlled. 


Figure  13.  Simple  8051  to  AD1 170  Interface 


To  initialize  the  interface,  first  write  “T’s  to  the  port  pins  connected 
to  the  data  bus  and  the  RD/  and  WR,'  control  lines.  This  puts 
the  8051  LO  lines  into  a  lightly  "pulled  up”  state,  simulating  a 
tri-stated  condition  on  the  bus  to  insure  that  neither  RD/  or 
WR/  are  selected: 


INIT: 

SETS 

PI.: 

;DISABLERD/ 

SETB 

Pl.3 

;A.N'D  WR/ 

.MOV 

p:,  #offh 

■SET  P2  TO  .ALL  ONES 

To  write  a  command  to  the  .ADI  170,  first  set  the  state  of  the 
Pl.l  and  Pl.O  lines  for  the  address  corresponding  to  the  byte  to 
be  written  to.  Set  the  P2  port  to  the  command  data,  then  strobe 
the  WR/  line  by  first  clearing  the  PI. 3  line  and  then  setting  it: 


WRCMD:  CLR 

Pl.O 

FIRST  CLE.AR  .AO  AND  A 1 

CLR 

Pl.l 

TO  POI.\TTOC.MD  BYTE 

.MOV 

P2,  #CNV 

CNV  IS  THE  OPCODE  FOR 

A  SINGLE  CONVERSION 

CLR 

Pl.3 

STROBE  THE  WR,'  LINE 

SETB 

Pl.3 

ONETIME 

.MOV 

P2,  #OFFH 

CLE.ARDAT.ABUSTO 

ALL ONES 

To  read  a  byte  from  the  .AD  1 170,  first  set  the  Pl.O  and  Pl.l 
lines  to  point  to  the  address  of  the  byte  desired.  Bring  the  RD' 
line  low,  reading  the  contents  of  P2.  Return  the  RD'  line  high: 

RDST.AT:  CLR 

Pl.O 

POINT  TO  STATUS  BYTE 

CLR 

Pl.l 

CLR 

PI.: 

BRING  RD  LINE  LOW 

.MOV 

.a.p: 

READ CONTENTS OF  BUS 

SETB 

Pi.: 

RESTORE  RD  LINE  HIGH 

'Note  that  the  SOS  I  microcontroller  t/oesconiain  a  conventional  busstrucrure; 
the  '"byre  banging"  interface  shown  here  is  presented  as  an  example  of  an 
altenuove  technique. 


*IBM  PC  is  a  trademark  of  International  Business  .Machines  Corp. 
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iSSURE  TRANSDUCER  DATA  ACQUISITION 
ro  module  solunoo  for  microcompuier  based  dau  acquisition 
I  a  1B31  hybrid  signal  conditioner  and  an  ADI  170  as  shown 
igure  14.  A  3  millivolt/ volt  pressure  transducer  (e.g.,  Dynisco’s 
series)  is  interfaced  to  a  model  1B31  configured  for  a  gain 
33.3,  to  provide  a  0  to  S  volt  output.  The  regulated  exciution 
age  is  S  volts,  and  is  used  as  the  reference  input  for  the 
1170  to  produce  tatiometric  operation.  This  configuration 
ds  very  high  CMR  enhanced  by  the  1B3I  low  pass  filter  and 
integrating  conversion  scheme  of  the  .‘VD1170. 

iddition,  fixed  offsets  caused  by  bridge  imbalance  can  be 
led  out  by  the  .ADI  170  with  a  power-up  initialization  command 
aa  the  microcomputer  (see  COMPENSATION  OF  EXTER- 
iL  OFFSETS  section).  The  full-scale  output  of  the  IB31  and 
msducer  can  also  be  normalized  to  .ADU70  full  scale  through 
electronic  calibration  command  ECAL.  Both  the  offset  and 
1-scaie  correction  dau  can  then  be  stored  in  nonvolatile  memory 
eliminate  repeating  this  uim  process  after  each  power-up. 
e  ADI  170  eliminates  a  potentiometer  or  software  overhead 
ich  might  otherwise  be  needed  for  these  functions. 


Figure  14.  Pressure  Transducer  Data  Acquisition  Using 
1831  and  AD1 170 
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Appendix  B  -  Simulation  Program 
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posi_eir_src  :POSI. 


Subroucin*  Model_0efaulc_3aca 
laiplicic  Mon* 

Inciud*  'S?_Globai_Comaon.inc' 
Inciud*  ’ S?_Sy3tam_7ariabl*s . inc • 
Include  ' S?_3if Jerenclal . inc ’ 
Inciud*  ’ S?_£v*nC3 . inc ' 

Inciud*  'posi_*rr . inc ‘ 


to  -  3.: 

Acc*l_.\iiip  •  3C.3 
Slope  »  16C0.0 
Inch*3_Moved  •  5.J 
Qt_Saniple  «  0.305 
01d_Sanipla  •  0 . 3 
Sanip_Fiit  Accel  «  0.3 
Vel  -  0.3~ 

OiQ_V*i  -  3.3 
Position  •  3.3 
Fc  -  30.3 

Nu!nbar_olf_3it3  -  36.3 
Pang*  -  386.-1 

Return 

S.-.d 


Subroutin*  Mod«i_0«scription 
Implicit  Non* 

Inciud*  'SP_Global_Comrion.inc' 
Inciud*  ' S?_System_Variable3 .inc' 
Include  'S?~Svent3.inc' 

Include  ' SP_0if ferential . inc ' 
Include  ‘ posi_arr . inc ' 


X_Index (Number_of_£guation3  -  1) 
X_Indax (Number_of_iguations  -  2) 
X_Index (Number_of_£quation3  ♦  3) 
X_Index (Sun'ber_of_2quations  ■>  4) 
X_Ind*x (Numbfcr_of_£quation3  S) 
X_Index (Numb*r_of _Equatlon3  6) 
X_Ind*x (Numb*r_of_Squatlon3  ♦  7) 

Xdot_Index  (Nujnber_of_Equations  1) 
Xdot_Index (Number_of _Equation3  *•  2) 
Xdot_Indax (Number_of_£quacions  »  3) 
Xdot_Index (Nu(nber_of_Equation3  *■  4) 
Xdot_Ind*x (Number_of_Equacion3  »  5) 
Xdot~Index (Number_of_Equacion3  *  6) 
Xdot_Ind«x (Nu.'nber_of_Equacions  *  7) 

Number  of  Equations  »  Nu.mber  of  Equacj 


ERR.F 


3001 

1003 

1005 
1007 

1025 

1026 
1051 

1000 

1002 

1004 

1006 
1026 

1023 

1024 

ons  »  7 


Return 

E.-.d 


posi_err_src:POSI_ERR.F 
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Subroutine  Setup_Modei 
Implicit  None 

Include  'SP_31obal_Common.inc' 

Include  ' S?_Sy scera_Variables . inc  * 

Include  ' SP^SvencaTinc ' 

Include  ' S?_Oif ferential. inc' 

Include  'po3i_9rr.inc' 

Real*8  ?_tocal,  A_ccef,  3_coef,  C_coef,  T2A 
?c  «  Samp_race/'(  .0 

A_coef  “  Accal_Amp* <1.0  »  Accai_Amp/ (2 . 0‘Slope) ) 

3_coef  -  5.'^*Accai_Amp**2.0/ (2.0»Slope) 

C_saef  -  2.0*«u-2i_Amp**3.0/ (Slope**2.0)  -  Inche3_Moved 

T2A  -  (-3_coaf  ♦  DSqrt  (B_coef’«2.0  -  4 . 0’'A_coef  «C_coef )  )  /  (2 . 0»A_coef ) 

Ii(T2A  .gt,  0.0)  Then 
T2  -  T2A 
Slae 

T2  -  (-3  coef  -  0Sqrt(B  csef**2.0  -  4.0*A  coef»C  coef ) ) / (2 . 0»A_coef ) 

End  If  ~ 

P  total  -  Accel  Amp'd.O  +  Accel  Amp/(2.0»Slope) )  *T2*'*2.0 
i  ~  *  T2*(5T0»Accel_Amp**2.07/(2.0»Slope) 

«  +■  2.0»Accel_Ainp^’3.0/ {Slope‘»2.0) 

Write <*,*)  'P_tocal  -  ',P_total 

T1  “  Accel_Amp/Siope 

Wc  -  2.0*3.1415''Fc 

Resolution  «  Range/ (2.0’*Sumber_of_Bit3) 

WriteC, •)  'Resolution  -  ',  Resolution,  '  in/sec2  or',  Rosolution/386 . 4 , 
WriteC*,*)  'Bandwidth  -  ',  sc,  '  Hz' 

Dt_Sample  -  1 . 0/Sa.'np_Rate 

Wtlte<»,»)  'Sampling  Rata  -  ',  Samp_Rate,  '  Hz' 

Writei*,*)  'Normal  Simulation  Rate  -  ',  1.0/Dtmax,  '  Hz' 

Write (*,*)  'Maximum  Simulation  Rate  -  ',  1.0/Dtmin,  '  Hz' 

SaJBple_Number  «  1 
Next_Tlme_to_Saraple  -  Dt_Sample 

Cail~SP_Scheduie  (Next_Time_to_^Sample,  Samp_Filter_Output) 

Return 

End 


Subroutine  Continuous_Model 
Implicit  None 

Include  '  S?_Global_Com!r.on .  InC 
Include  ' S?_Systera_Variables . inc' 
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posi_err_src:POSI_ERR.F 


Include  'SP_SvanC3.inc' 
Include  'SP_Oifferential.inc* 
Include  'posl_err.lnc‘ 


Ince9er*4  1 
Real'S  Step 


Input_Accel 


Slope'  (t 
Slope'  (t 
Slope'  (t 
Slope' (c 
Slope' (t 
2.0'Slape 


-  Td) 

-  (Td 

-  (Td 

-  (Td 

-  (Td 
(C  - 


'SCep(Td) 

-  2.0'Tl) ) 'SCep(Td  -  2.3'Tl) 

+  2.0'Tl  *  T2/2.0) ) *Step(Td  ■ 

-  S.O'Tl  *  12/2.0) ) 'Step(Td  ■ 


2.0'Slopa'(t  - 
2.0'Slopa»(t  - 
2.0*Slope'(C  - 
2.Q'Slope'(t  - 
2.0»Slope'(C  - 
Slope' (t  -  (Td 


<■  5.3'Tl  -  1 
(Td  *  S.O'Tl 
(Td  7.3'Tl 
(Td  +  a.O'Tl 
(Td  T  S.O'Tl 
(Td  *  10.0'Tl 
(Td  -I-  11.0'Tl 


12.: 


3’T2) ) 'SCep(Td 
♦  l.S’T2) ) 'Step(Td 
V  1.5'T2) ) 'Step(Td 
■K  l.S'T2)  ) 'Step(Td 
^  1.5'T2) ) 'Step(Td 
♦  1.5'T2) ) »Step(Td 
+  1.5'T2) ) 'Step(Td 


2.0'Tl 
5 . O'Tl 
S.O'Tl 


T2/2.C 

T2/2.C 

l.S'Tl 


+  S.O'Tl  + 
+  7. O'Tl  + 
+  S.O'Tl  + 
+  S.O'Tl  + 
10. O'Tl 
11. O'Tl 


1, 

1. 

1. 

1. 


1.3*T2)  ) 'Stepdd  -r  12. O'Tl  t  1.5' 


Inpuc_Accel  -  Slope' (c  -  Td)'Step(Td) 


-  Slooe'(t  -  (Td  ^  Tl))'Step(Td  Tl) 

-  Slooe'(t  -  (Td  Tl  *  T2))'Step(Td  r  Tl  +  T2) 

(Td  +  3. O'Tl  +  T2))'Step(Td  3. O'Tl  '  T2) 

(Td  '  3. O'Tl  2.0'T2) )  *Step(Td  -r  3. O'Tl  +  2.3'7 
(Td  '  4. O'Tl  ♦  2.0'T2) )  •Step(Td  4. O'Tl  +  2.0'1 


*  Slope' (t  - 
'  Slope* (t 
-  Slope' (c 


xl_doc  «  -0.7SS4'Wc'xl  '  x2 
x2”doc  •  -Sc'Wc'xl  +  Wc'Wc'Input^Accel 
x3~dot  ■  -1.8478'Mc'x3  ♦  x4  ^ 
x4"’dot  •  -Wc*Wc'x3  Wc'Wc'xl 


Flltered_Accel  -  x3 

PE  "  Real  Posi  -  Position 


Write (•/')  'In  Continuous_Modei  at  t  «  ',t 
Do  i  -  1000, 102S 

Write  (',*)  i,  Giobal_Conmon  (1) 

End  Do 


Do  1 


o  i  -  1030, 1031 
Write(',  ')  i,  I.nteger_Glocal_Conimon(l,  i) 
End  Do 


Return 

End 


Subroutine  Discrete  Model 


Implicit  None 


Include  'SP_Global_Co.Tjnon.inc' 
Include  '  S?_System~'/ariables .  inc ' 
I.nclude  'SP_Events .  inc ' 

Include  'S?_Dif3erential.inc' 
Include  ’posi_err . inc ' 


Inteqer'4  i 


o  o 


posi_err_src:POSI_ERR.F 
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c  Write (*,•)  'In  Discrete  Model  at  t  -  *,c 

c  Do  i  -  1000,1029 

c  Write(*,*)  i,Global_Cominon(i) 

£nd  Do 

c  Do  i  -  1030,1331 

c  Write{*,‘')  i,  Integer_Giobai_Conmon(l,i) 

c  End  Do 

If  (Events  !l)  .eq.  Sainp_“ilter_Out?ut)  Then 
01d_3asipla  «  3amp_rilt_Accai 

3anip_:  ilt_Accei  -  aesoiution'OInt  ("iltared_Accei/aesoiution) 
01d_Vai  -  Vai 

Vei  •  Vai  +  (01d_Sain?ie  »  Samp_?ilC_Accel)  •Dt_Sainple/2 . 0 

Position  “  Position  +  (Oid_Vel  +  Vei) •0t_Sample/2 . 0 

Sampie_Nuini5er  »  3ampia_Mumbet  -i-  1 
Mexc_TLTie_;o  Sample  •  Dt_3arapla’Sample_Muiabar 

Cali  S9_Scheduie (Next_Tiae_to_Saraple,  Samp_Filter_Gutput) 


End  Zi 


Return 

End 


Subroutine  Model_Terniination 
Implicit  None 

Include  'S?_Global_Common.inc' 

Include  '  S?_Systeni3variables .  inc ' 

Include  ' S?_Di£f erentiai.inc' 

Include  'S?_Svent3.inc' 

Include  'posi_err . inc ' 

If  (t  .ge.  (Td  ‘  12.0T1  +  1.5»T2  0.1) )  Then 

End  of  Run  •  .TRUE. 

End  If 

Return 

End 


V 


posi_err_src:S  tep  J 

Double  Precision  Function  Step (time  to  step) 
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this  function  is  the  step  function, 
i.e.  Step (time  to  step)  -  1.0  if  t  >-  time  to  step 

Step (tine  to  step)  -  0.0  if  t  <  time  to  step 


Include  global  common  block  definitions  I 


I.’nplicit  ({one 

Include  'S?_Globai_Common.inc' 
Include  ' SP^System'Variables . inc' 


*  Variable  Declarations 


Double  Precision  time  to  step 


•  Begin  Code 


If  (t  .ge.  time  to  step)  then 
Step  ••  l.OdO 
Slse 

Step  •  O.OdO 
End  If 

Return 

End 


J 
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posi_err_mc:POSl_ERR.INC 

Intaqer*4  Sampie_Suinber,  Samp_rilter_Output 


Real*8  xl, 

xl_dot, 

TO, 

01d_Vel, 

Samp_rilt_Accel 

x2. 

xE^dot, 

Tl, 

Slope, 

01d_Sample, 

x3, 

x3_dot , 

T2, 

Position, 

Inches_Moved, 

x4. 

x4_dot. 

Vei, 

0t_Samplo, 

Accei_Amp, 

Fc, 

Wc, 

PE, 

Input_Accel, 

Ranqe, 

&  Next_Time_to_Sample,  kesolucion, 

6  Real2?osi7  Reai_Vai,  rilcared_Accal, 

4  Samp^Race,  I?E,  Sua>ber_of_3ir3 


Parameter  (Samp_rilter_Out?ut  -  1) 


Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 


(Global_Ccnunon  ( ICOO) , 
(Giobai_Camnion(1001! , 
(Global^Gommon (1002) , 
(Globai_Common (1003) , 
(Glabal_Camman (1004) , 
(Global_Cammon (1005) , 
(Giobai_Oc(nmon  (1CC6) , 
(Global  Common (1007) , 


xl_clct) 

xl) 

x2_cloc) 

x2) 

x3_<loc ) 
x3) 

x4_ciot) 

x4) 


Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 

Equivalence 


{Globai_Common (1008) , 
(Global_Common (1009) , 
(Giobai_Conunon  (1010)  , 
(Global_Common(1011) , 
(Global^Oommon ( 1012)  / 
(Globai_Common(1013) , 
(Global”common(1014) , 
( G1  obal”Conunon  (1015), 
(Global~Common(1016) , 
(Global~Common(1017) , 
(Global~Cammon (1018) , 
(Global~Common(1019) , 
(Global_Common (1020) , 
(Global^Comraon (1021) , 
(Global~Common (1022) , 
(Global^Common (1023) , 
(Global_Common (1024) , 
(Giobal~Common (1025) , 
(Giobai_Comnon(1026)  , 
(Global_Comnon (1027)  , 
(Globai_Common(1023) , 
(Globai_Common ( 1029)  , 
(Globai_Common ( 1030)  , 
(Global~Comiiion  (1031) , 


TD) 

Accel_Amp) 

Slope) 

Inches_Moved) 

Dt_Sample) 

Old^Sample) 

Samp  Filt  Accel) 
Vel)~ 

Old^Vel) 

Position) 

Tl) 

T2) 

Next  Time  to  Sample) 
wc)  “ 

Fc) 

Input  Accel) 

PE) 

Real_?osi) 

Reai_Vei) 

Resolution) 

Ranqe) 

F iltered_Accel ) 
Sampie_Number) 
Sumber'’of  3its) 


Equivalence  (Global_Common  (1050)  ,  Samp_!tate) 
Equivalence  (Global^Common ( 1051) ,  IPE)~ 


V 


Appendix  C  -  Real-Time  Position  Determination  Program 


# include  <graph.h> 

# include  <string.h> 

# include  <inath.h> 

# include  <stdlib.h> 

# include  <stdio.h> 

# include  <conio.h> 

# include  <tiine.h> 

# include  <bios.h> 

# include  "iarinc.b” 

void 

calibrate_AD1170  (void) , 
calibrate_QA2000  (void) , 
coininand_anorad  (char  *ano_buffer)  , 

display_inenu_itein  (int  left_row,  int  left_col,  char  *str,  int  len)  , 

draw_Tnenu_box  (int  up_left_row,  int  up_left_col,  int  height,  int  width) , 

free_run_mode  (void) , 

setup_ADC_defaults  (void) , 

setup_anorad  (void) , 

main  (void) , 

wait_for  (double  seconds) , 
wait_for_A  (void) , 
wait_for_B  (void) ; 

int 

get_menu  (int  row,  int  col,  char  *  *items) ; 
unsigned 

cursor  (unsigned  value) ; 
double 

do__zupt  (int  numb_data_points) , 

exper_l  (void) , 

exper_2  (void) , 

exper__3  (void)  , 

exper_4  (void) , 

exper_5  (void) , 

exper_6  (void) , 

integrate_and_raove  (double  seconds,  char  *ano_buffer) , 
read_A  (void) , 
read_B  (void) , 
read_position  (void) , 

setup_ADC_int_time  (double  frequency) , 
setup_counter  (double  frequency) ; 

/*  Main  Menu  Definitions  */ 

char 

*mnuMain[]  = 

( 

"System  Setup", 

"Experiments" , 

"Free-Running  Position  Display", 

"Quit", 

NULL 

); 

#define  SYS_SETUP  0 
#define  EXPER  1 
#define  FREE_RUN  2 
tdefine  QUIT  3 


/*  Menu  for  System  Setup  */ 


char 


*innuSys  [  ]  = 

{ 

"Calibrate  QA2000”, 
"Calibrate  AD1170's", 

"Select  Integration  Method", 
"Select  Sampling  Rate", 
"RETURN  TO  MAIN  MENU", 

NULL 


#define  CAL_QA2000  0 
#define  CAL_AD1170  1 
#define  SEL_INTEG  2 
#define  SEL  SAMP  3 


5fdefine  RETURN_FRCM_SYS  4 
/*  Menu  for  Experiments  */ 
char 

*mnuExp [ ]  = 

{ 

"Single  Motion  Test", 

"Multiple  Motion  Test  w/ZUPT", 

"Multiple  Motion  Test  w/ZUPT  &  Unkown  Base", 
"Multiple  Motion  Test  w/ZUPT  &  Known  Base", 
"Multiple  Motion  Test  w/ZUPT  &  2  Known  Bases  (Ml)", 
"Multiple  Motion  Test  w/ZUPT  &  2  Known  Bases  (M2)", 
"RETURN  TO  MAIN  MENU", 

NULL 


#define  SINGLE  0 

#define  ZUPT  1 

#define  ZUPT_BASE  2 

# define  ZUPT_KNOWN_BASE  3 

#define  ZUPT_2_KN0WN_BASES  4 
#define  ZUPT_2_KNOWN_BASES_M2  5 
#define  RETURN_FROM_EXP  6 

/*  Menu  for  Integration  Methods  */ 

char 

*mnulnteg[]  = 

{ 

"Simpson's  Rule", 
"Trapezoidal" , 
"Adam-Basforth" , 

"RETURN  TO  MAIN  MENU", 

NULL 


#define  SIMP 
fdefine  TRAP 
tdefine  ADAM 
#define  RETURN 

int 

integ_alg,  center_row,  center_col; 
double 

SF,  bias,  bias_time,  vel,  dt,  dt_2,  dt_12. 


0 

1 

2 

FROM  INTEG  3 


dt  24; 


/*  video  configuration  structure  (graph. h)  */ 


struct  videoconfig 
vid_config; 

/*  Structure  for  menu  attributes  */ 

struct  mnuAtr 

{ 

int  fgNormal,  fgSelect,  fgBorder; 

long  bgNormal,  bgSelect,  bgBorder; 

int  centered ; 

char  nw [ 2 ] ,  ne [ 2 ] ,  se [ 2 ] ,  sw [ 2 ] ,  ns ( 2 ] ,  ew [ 2 ] ; 


/*  Color  menu  attributes  */ 

struct  mnviAtr 
menus  = 

{ 

OxOf,  0x01,  OxOf, 

0x01,  OxOf,  0x01, 

TRUE, 

II  -It  11^  II  II J  II  11  Lii  II  I  II  ii_ii 

r  »  1  »  /  /  I  / 


/*  Monochrome  menu  attributes  */ 

struct  mnuAtr 
bwmenus 
{ 

0x07,  0X00,  0x07, 

0x00,  0x07,  0X00, 

TRUE, 

II  -II  11-  II  II J  II  II  Lii  II  I  II  ii_ii 

r  r  1  f  I  /  I  / 

); 


FILE 

*log_ptr ; 


void  main  () 

{ 

char 

string[80],  file_name[80] ; 
int 

choice,  i_cnt,  numb_runs; 
double 

samp_freq,  freq,  int__freq,  p_err,  p_err_sum,  P_err_avg, 
p_err_sq_sum,  p_err_sq_avg,  max_err,  f_band,  ad_range; 

/*  Open  output  file  */ 

printf  ("\nEnter  name  of  log  file:  ") ; 
gets  (file_name); 


I 


log_ptr  =  fopen  (file^name,  ”w") ; 
if  (logjptr  ==  NULL)  ' 

{ 

printf  (''\n\n\t***  Could  not  open  %s  for  writing  ***”,  file_naine)  ; 
exit(O) ; 

} 


setup_anorad  ( ) ; 

outp  (CNTR_STOP,  0X0000) ;  /*  Disarm  2MCLK  */ 

setup_ADC_def aults  ( ) ; 

freq  =  200.0; 
integ_alg  =  TRAP; 
bias  =  0.0; 

samp_freq  =  setup_counter  (freq) ; 

dt  =  l/samp_freq; 
dt_2  =  dt/2.0; 
dt_12  »  dt/12.0; 
dt_24  *=  dt/24.0; 

int_freq  =  setup_ADC_int_time  (sainp_freq)  ; 

outp  (CNTR_START,  0x0000) ;  /*  Arm  2MCLK  */ 

__getvideoconf  ig  (&vid__config)  ; 
center^row  =  vid_config.numtextrows  /  2; 
center~col  =  vid_config.numtextcols  /  2; 

_setvideomode  (_DEFAULTMODE) ; 

calibrate_QA2000  () ; 

_setbkcolor  ((long)  0); 

_clearscreen  (_GCLEARSCREEN) ; 

_setbkcolor  ((long)  1); 

_settextcolor  ((short)  15); 

_settextposition  (center_row,  center^col  -  13)  ; 

~outtext  ("Enter  filter  bandwidth  (Hz):  ") ; 

gets  (string) ; 

f_band  =  atof  (string) ; 

_setbkcolor  ((long)  0); 

_clear screen  (_GCLEARSCREEN) ; 

_setbkcolor  ((long)  1); 

_settextcolor  ((short)  15); 

_settextposition  (center_row,  center_col  -  13)  ; 

_outtext  ("Enter  A-to-D  range  (Gs) ;  ") ; 

gets  (string) ; 

ad_range  =  atof  (string) ; 

_setbkcolor  ((long)  0); 

_clearscreen  (_GC LEARS GREEN) ; 

/*  Select  and  branch  to  menu  choices  */ 

do 

{ 


_setbkcolor  ((long)  1); 

_settextcolor  ((short)  15); 
settextposition  (1,  center_col  -  13)  ; 

_outtext  ( '•  lAR  DEMONSTRATION  PROGRAM  '' )  ; 

choice  =  get_menu  (center_row,  center_col,  mnuMain) ; 

switch  (choice) 

( 

case  SYS_SETUP: 

choice  *  get_menu  (center_row,  center_col,  mnuSys) ; 
switch  (choice) 

{ 

case  CAL_QA2000: 

calibrate_QA2000  ()  ; 
break; 

case  CAL_AD1170; 

calibrate_AD1170  (); 
break; 

case  SEL_INTEG; 

choice  =  get_inenu  (center_row,  center_col,  mnuinteg)  ; 
switch  (choice) 

{ 

case  SIMP: 

integ_alg  =  SIMP; 
break; 

case  TRAP: 

integ_alg  =  TRAP; 
break; 

case  ADAM: 

integ_alg  =  ADAM; 
break; 

} 

break; 

case  SEL_SAMP: 

outp  (CNTR_STOP,  0x0000)  ;  /*  Disarm  2MCLK 


do 

{ 

setbkcolor  ((long)  0) ; 

_clearscreen  (_GCLEARSCREEN) ; 

_setbkcolor  ((long)  1); 

_settextcolor  ((short)  15); 

_settextposition  (center_row,  center_col  -  13) ; 
_outtext  ("Enter  sampling  rate  (Hz) :  ") ; 
gets  (string) ; 
freq  =  atof  (string); 

) 

while  (freq  <  31.0  ||  freq  >  490.0); 

samp_freq  -  setup_counter  (freq) ; 

dt  =  l/sainp_freq; 
dt_2  =  dt/2.0; 
dt_12  =  dt/12.0; 
dt_24  =  dt/24.0; 


int_freq  =  setup_ADC__int_time  (sainp_freq)  ; 
outp  (CNTR_START,  0x0000) ;  /*  Arm  2MCLK  */ 

break ; 

case  RETURN_:-’ROM_SYS: 
break; 

> 

break; 
case  EXPER: 

choice  =  get_menu  (center_row,  center_col,  itinuExp)  ; 
switch  (choice) 

{ 

case  SINGLE: 

fprintf  (log_ptr,  ” \n\n\n\n\t\t\tS INGLE \n") ; 

_setbkcolor  ((long)  0); 

_clearscreen  (_GCLEARS GREEN) ; 

_setbkcolor  ((long)  1); 

_settextcolor  ((short)  15); 

_settextposition  (center_row,  center_col  -  11) ; 

_outtext  ("Enter  number  of  runs:  ") ; 

gets  (string) ; 

numb_runs  =  atoi  (string) ; 

bias_time  =  0.0; 

p_err  =*  0.0; 
p~err_sum  *  0.0; 
p”err_sq_suni  =  0.0; 
max_err  =  0.0; 

for  (i_cnt  *  0;  i_cnt  <  numb_runs;  ++i_cnt) 

{ 

p_err  =  exper_l  () ; 

p_err_sum  =  p_err_sum  +  p_err; 

p_err_sq_sura  =  p_err_sq_sum  +  p_err*p_err; 

if  (fabs (max_err)  <  fabs(p_err)) 

{ 

inax_err  =  p_err; 

} 

) 

p_err_avg  =  p_err_sum/ ( (double)  numb_runs) ; 
p_err_sq_avg  =  p_err_sqLsuin/ ( (double)  numb_runs)  ; 

_clearscreen  (_GCLEARS GREEN) ; 

_settextposition  (1,  center_col  -  3) ; 

_outtext  ("SINGLE"); 

_settextposition  (3,  1); 

sprintf  (string, 

"Mean  Error  =  %12.4g  (inches)  STD  =  %12.4g  (inches)" 
p_err_avg , 

sqrt (p_err_sq_avg  -  p_err_avg*p_err_avg) ) ; 

_outtext  (string) ; 

sprintf  (string,  "\nMax  Error  =  %12.4g  (inches)",  max_err) ; 


( inches) " , 


_outtext  (string) ; 

sprintf  (string,  ''\nSainpling  rate  =  %g  (Hz)",  sainp_freq)  ; 
_outtext  (string) ; 

sprintf  (string,  "\nFilter  bandwidth  =  %g  (Hz)",  f_band) ; 
_outtext  (string) ; 

sprintf  (string,  "\nA-to-D  Range  =  %g  (Gs)",  ad_range) ; 
_outtext  (string) ; 

sprintf  (string,  "\nIntegration  method  =  %d  ",  integ_alg) ; 
_outtext  (string) / 

_outtext  ("\n  (0-Simp  1-Trap  2-Adam)"); 

sprintf  (string,  "\nNumber  of  runs  =  %d  ",  numb_runs) ; 

_outtext  (string) ; 

fprintf  (log_ptr, 

"\n\nMean  Error  *  %12.4g  (inches)  STD  =  %12.4g 

p_err_avg, 

sqrt (p_err_sq_avg  -  p_err_avg*p_err_avg) ) ; 
fprintf  (log_ptr,  "\nMax  Error  =  %12.4g  (inches)",  max_err) ; 
fprintf  (log_ptr,  "\nSampling  rate  =  %g  (Hz)",  samp_freq) ; 
fprintf  (log_ptr,  "\nFilter  bandwidth  *  %g  (Hz)",  f_band) ; 
fprintf  (log_ptr,  "\nA-to-D  Range  =  %g  (Gs)",  ad_range) ; 
fprintf  (log_ptr,  "\nIntegration  method  =  %d  ",  integ_alg) ; 
fprintf  (log_ptr,  "\n  (0-Simp  1-Trap  2-Adam)"); 

fprintf  (logjptr,  "\nNumber  of  runs  =  %d  ",  numb_runs) ; 

__settextposition  (center_row+2,  center^col  -  19)  ; 

“outtext  ("Press  <Ent€r>  to  return  to  main  menu."); 
gets  (string) ; 

break; 


case  ZUPT: 

fprintf  (log_ptr,  "\n\n\n\n\t\t\tZUPT  ONLY\n") ; 

_setbkcolor  ((long)  0); 

_clearscreen  (_GCLEARSCREEN) ; 

_setbkcolor  ((long)  1); 

_settextcolor  ((short)  15); 

_settextposition  (center_row,  center_col  -  11)  ; 
_outtext  ("Enter  number  of  runs:  ”) ; 
gets  (string) ; 
numb_runs  *  atoi  (string) ; 

bias_time  =  0.0; 

p_err  =  0.0; 
p_err_sum  =  0.0; 
p_err_sq_sum  =  0.0; 
max_err  =  0.0; 

for  (i_cnt  =  0;  i_cnt  <  numb_runs;  ++i_cnt) 

{ 

p_err  =  exper_2  () ; 
p_err_sum  =  p_err_sum  +  p_err; 


( inches) ” , 


p_err_sq_suin  =  p_err_sq_suin  +  p_err*p_err; 

if  ( fabs  (inax_err)  <  fabs(p_err)) 

{ 

max  err  =  p_err; 

} 

) 

p_err_avg  =  p_err_sum/ ( (double)  numb_runs) ; 
p”err_sq_avg  =  p_err_sq_sum/ ( (double)  numb_runs) ; 

_clearscreen  (_GCLEARS GREEN) ; 

_settextposition  (1,  center_col  -  4)  ; 

_outtext  C'ZUPT  ONLY"); 

_settextposition  (3,  1)  ; 

sprintf  (string, 

"Mean  Error  =  %12.4g  (inches)  STD  =  %12.4g  (inches)", 
p_err_avg , 

sqrt (p_err_sq_avg  -  p_err_avg*p_err_avg) ) ; 

_outtext  (string) ; 

sprintf  (string,  "\nMax  Error  =  %12.4g  (inches)",  inax_err)  ; 
_outtext  (string) ; 

sprintf  (string,  "\nSampling  rate  =  %g  (Hz)",  samp_freq) ; 
_outtext  (string) ; 

sprintf  (string,  "\nFilter  bandwidth  *=  %g  (Hz)",  f_band)  ; 
__outtext  (string)  ; 

sprintf  (string,  "\nA-to-D  Range  =  %g  (Gs)",  ad_range) ; 
_outtext  (string) ; 

sprintf  (string,  "\nIntegration  method  =  %d  ",  integ_alg) ; 
_outtext  (string) ; 

_outtext  ("\n  (0-Simp  1-Trap  2-Adam)"); 

sprintf  (string,  "\nNumber  of  runs  =  %d  ",  numb_runs) ; 

_outtext  (string) ; 

fprintf  (log_ptr, 

"\n\nMean  Error  =  %12.4g  (inches)  STD  =  %12.4g 

p_err_avg , 

sqrt (p_err_sq_avg  -  p_err_avg*p_err_avg) ) ; 
fprintf  (log_ptr,  "\nMax  Error  =  %12.4g  (inches)",  max_err) ; 
fprintf  (log_ptr,  "\nSampling  rate  =  %g  (Hz)",  samp_freq) ; 
fprintf  (log_ptr,  "\nFilter  bandwidth  =  %g  (Hz)",  f_band) ; 
fprintf  (log_ptr,  "\nA-to-D  Range  =  %g  (Gs)",  ad_range) ; 
fprintf  (log_ptr,  "\nIntegration  method  =  %d  ",  integ_alg) ; 
fprintf  (log_ptr,  "\n  (0-Simp  1-Trap  2-Adam)"); 

fprintf  (log_ptr,  "\nNumber  of  runs  =  %d  ",  numb_runs) ; 

_settextposition  (center_row+2 ,  center_col  -  19) ; 

_outtext  ("Press  <Enter>  to  return  to  main  menu."); 
gets  (string) ; 


break; 


case  ZUPT  BASE: 


fprintf  (log_ptr,  "\n\n\n\n\t\t\tZUPT  W/ONE  UNKNOWN  BASE\n") 

_setbkcolor  ((long)  0); 

_clearscreen  (_GCLEARSCREEN) ; 

_setb)ccolor  ((long)  1); 

_settextcolor  ((short)  15); 

_settextposition  (center_row,  cehter__col  -  11)  ; 

_outtext  ("Enter  number  of  runs:  ") 

gets  (string) ; 

numb_runs  =  atoi  (string) ; 

p_err  =  0.0; 
p~err_sum  =  0.0; 
p_err_sq_sum  =  0.0; 
max_err  =  0.0; 

for  (i_cnt  =  0;  i_cnt  <  numb_runs;  ++i_cnt) 

{ 

p_err  =  exper_3  () ; 

p_err_sum  =  p_err_suin  +  p_err; 

p_err_sq_sum  =  p_err_sq_sum  +  p_err*p_err; 

if  (fabs (max_err)  <  fabs(p_err)) 

{ 

max_err  =  p_err; 

} 

} 

p_err_avg  =  p_err_sum/ ( (double)  numb_runs)  ; 
p_err~sq_avg  =  p__err_sq_sum/ ( (doubleY  nuinb_runs)  ; 

_clearscreen  (_GCLEARSCREEN) ; 

_settextposition  (1,  center_col  -  11) ; 

_outtext  ("ZUPT  W/ONE  UNKOWN  BASE"); 

_settextposition  (3,  1) ; 

spr int f  ( string , 

"Mean  Error  =  %12.4g  (inches)  STD  =  %12.4g  (inches)' 
p_err_avg , 

sqrt (p_err_sq_avg  -  p_err_avg*p_err_avg) )  ; 

_outtext  (string) ; 

sprintf  (string,  "\nMax  Error  =  %l2.4g  (inches)",  max_err) ; 
_outtext  (string) ; 

sprintf  (string,  "\nSarapling  rate  =  %g  (Hz)",  samp_freq) ; 
_outtext  (string) ; 

sprintf  (string,  "\nFilter  bandwidth  =  %g  (Hz)",  f_band) ; 
_outtext  (string) ; 

sprintf  (string,  "\nA-to-D  Range  =  %g  (Gs)",  ad_range) ; 
_outtext  (string) ; 

sprintf  (string,  "\nIntegration  method  =  %d  ",  integ_alg) ; 
_outtext  (string) ; 

_outtext  ("\n  (0-Simp  1-Trap  2-Adam)"); 

sprintf  (string,  "\nNuinber  of  runs  =  %d  ",  numb_runs)  ; 


(inches) ” , 


_outtext  (string) ; 
fprintf  (log_ptr, 

•'\n\nMean  Error  *  %12.4g  (inches)  STD  =  %12.4g 

p_err_avg, 

sqrt  (p_err_sq__avg  -  p_err_avg*p_err_avg) )  ; 
fprintf  (logjptr,  ''\nMax  Error  =  %12.4g  (inches)”,  max_err)  ; 
fprintf  (log_ptr,  ”\nSa»ipling  rate  =  %g  (Hz)”,  samp_freq)  ; 
fprintf  (log_ptr,  ”\nFilter  bandwidth  =  %g  (Hz)”,  f_band) ; 
fprintf  (log_ptr,  ”\nA-to-D  Range  *  %g  (Gs)”,  ad_range) ; 
fprintf  (log_ptr,  ”\nIntegration  method  =  %d  ”,  integ_alg) ; 
fprintf  (log_ptr,  ”\n  (0-Simp  1-Trap  2-Adam)"); 

fprintf  (log_ptr,  ”\nNumber  of  runs  =  %d  ”,  numb_runs)  ; 

_settextposition  (center_row+2 ,  center_col  -  19); 

_outtext  ("Press  <Enter>  to  return  to  main  menu."); 
gets  (string) ; 


break; 


case  ZUPT_KNOWN_BASE : 

fprintf  (log_ptr,  "\n\n\n\n\t\t\tZUPT  W/ONE  BASE\n") ; 

_setbkcolor  ((long)  0); 

_clearscreen  (_GCLEARSCREEN) ; 

_setbkcolor  ((long)  1); 

_settextcolor  ((short)  15); 

_settextposition  (center_row,  center_col  -  11) ; 
_outtext  ("Enter  number  of  runs:  ”) ; 
gets  (string) ; 
numb_runs  =  atoi  (string) ; 

p_err  =  0.0; 
p_err_sum  =  0.0; 
p_err_sq_sum  =  0.0; 
max_err  =  0.0; 

for  (i_cnt  =  0;  i_cnt  <  numb_runs;  ++i_cnt) 

( 

p_err  =  exper_4  ( ) ; 

p_err_sum  =  p_err_sum  +  p_err; 

p_err_sq_sum  =  p_err_sq_sum  +  p_err*p_err; 

if  (fabs (max_err)  <  fabs(p_err)) 

{ 

max_err  =  p_err; 

} 

} 

p_err_avg  =  p_err_sura/ ( (double)  numb__runs)  ; 
p_err_sq_avg  =  p_err_sq_sum/ ( (double)  numb_runs) ; 

_clearscreen  (_GCLEARS GREEN) ; 

_settextposition  (1,  center_col  -  7) ; 

_outtext  ("ZUPT  W/ONE  BASE") ; 

_settextposition  (3,  1); 

sprintf  (string, 

"Mean  Error  =  %l2.4g  (inches) 


STD  =  %12.4g  (inches) ", 


( inches) " , 


p_err_avg , 

sqrt (p_err_sq_avg  -  p_err_avg*p_err_avg) ) ; 

_outtext  (string) ; 

sprintf  (string,  "\nMax  Error  =  %12.4g  (inches)",  itiax_err)  ; 
_outtext  (string) ; 

sprintf  (string,  "\nSainpling  rate  =  %g  (Hz)”,  sainp_freq)  ; 
_outtext  (string) ; 

sprintf  (string,  ”\nFilter  bandwidth  =  %g  (Hz)",  f_band) ; 
_outtext  (string) ; 

sprintf  (string,  "\nA-to-D  Range  =  %g  (Gs)",  ad_range) ; 
_outtext  (string) ; 


sprintf  (string,  "\nIntegration  method  =  %d  ”, 
_outtext  (string) ; 


integ_alg) ; 


_outtext  ("\n 


(0-Simp  1-Trap 


sprintf  (string,  "\nNuiaber  of  runs  =  %d  ” 
_outtext  (string) ; 

fprintf  (log_ptr, 

”\n\nMean  Error  =  %12.4g  (inches) 


2 -Adam) ”) ; 

numb_runs) ; 


STD  =  %12.4g 


p_err_avg, 

sqrt (p_err_sq_avg  -  p_err_avg*p_err_avg) ) ; 
fprintf  (log_ptr,  "\nMax  Error  =  %12.4g  (inches)",  max_err) 
fprintf  (log_ptr,  "\nSampling  rate  =»  %g  (Hz)",  samp_freq)  ; 
fprintf  (log_ptr,  ”\nFilter  bandwidth  =  %g  (Hz)”,  f_band) ; 
fprintf  (log_ptr,  ”\nA-to-D  Range  =  %g  (Gs)”,  ad_range) ; 
fprintf  (log_ptr,  ”\nIntegration  method  =  %d  ”,  integ_alg) ; 
fprintf  (log_ptr,  ”\n  (0-Simp  1-Trap  2-Adam)"); 

fprintf  (log_ptr,  "\nNurober  of  runs  =  %d  ”,  numb_runs) ; 

_settextposition  (center_row+2 ,  center_col  -  19) ; 

_outtext  ("Press  <Enter>  to  return  to  main  menu."); 
gets  (string) ; 

break; 


case  ZUPT_2_KN0WN_BASES : 

fprintf  (log_ptr,  "\n\n\n\n\t\t\tZUPT  W/2  BASES  (Ml)\n"); 

_setbkcolor  ((long)  0); 

_clearscreen  (_GCLEARSCREEN) ; 

_setbkcolor  ((long)  1); 

_settextcolor  ((short)  15); 

_settextposition  (center_row,  center_col  -  11) ; 

_outtext  ("Enter  number  of  runs;  ") ; 

gets  (string) ; 

numb_runs  =  atoi  (string) ; 

p_err  *  0.0; 
p_err_sum  =  0.0; 
p_err_sq_sum  =  0.0; 
max_err  =  0.0; 

for  (i_cnt  =  O;  i_cnt  <  numb_runs;  ++i_cnt) 


( inches) " , 


{ 

p_err  =  exper_5  () ; 

p_err_suin  *  p_err_suin  +  p_err; 

p_err”sq_sum  =  p_err_sq_suin  +  p_err*p_err; 

if  (fabs (niax_err)  <  fabs(p_err)) 

{ 

niax_err  =  p_err; 

} 

} 

p_err_avg  =  p_err_sum/ ( (double)  nuinb_runs)  ; 
p_err~sq_avg  =  p_err_sq_s\im/ ( (double)  numb_runs)  ; 

_clearscreen  (_GCLEARS GREEN) ; 

_settextposition  (1,  center_col  -  10)  ; 

_outtext  ("ZUPT  W/2  BASES  (Ml)”); 

_settextposition  (3,  1) ; 

sprintf  (string, 

"Mean  Error  =  %12.4g  (inches)  STD  =  %12.4g  (inches)", 
p_err_avg , 

sqrt (p_err_sq_avg  -  p_err_avg*p_err_avg) ) ; 

_outtext  (string) ; 

sprintf  (string,  "\nMax  Error  =  %12.4g  (inches)",  inax_err)  ; 
_outtext  (string) ; 

sprintf  (string,  "\nSaiiipling  rate  =  %g  (Hz)",  samp_freq)  ; 
_outtext  (string) ; 

sprintf  (string,  "\nFilter  bandwidth  =  %g  (Hz)",  f_band) ; 
_outtext  (string) ; 

sprintf  (string,  "\nA-to-D  Range  =  %g  (Gs)",  ad_range) ; 
_outtext  (string) ; 

sprintf  (string,  "\nIntegration  method  =  %d  ",  integ_alg) ; 
_outtext  (string) ; 

_outtext  ("\n  (0-Simp  1-Trap  2-Adam)"); 

f 

sprintf  (string,  "\nNumber  of  runs  =  %d  ",  numb_runs) ; 

_outtext  (string) ; 

fprintf  (log_ptr, 

"\n\nMean  Error  =  %12.4g  (inches)  STD  =  %12.4g 

p_err_avg, 

sqrt (p_err_sq_avg  -  p_err_avg*p_err_avg) ) ; 
fprintf  (log_ptr,  "\nMax  Error  =  %12.4g  (inches)",  max_err) ; 
fprintf  (log_ptr,  "\nSampling  rate  =  %g  (Hz)",  samp_freq) ; 
fprintf  (log_ptr,  "\nFilter  bandwidth  =  %g  (Hz)",  f_band) ; 
fprintf  (log_ptr,  "\nA-to-D  Range  *  %g  (Gs)",  ad_range) ; 
fprintf  (log_ptr,  "\nIntegration  method  =  %d  ",  integ_alg) ; 
fprintf  (log_ptr,  "\n  (0-Simp  1-Trap  2-Adam)"); 

fprintf  (log_ptr,  "\nNumber  of  runs  =  %d  ",  numb_runs) ; 

_settextposition  (center_row+2 ,  center_col  -  19) ; 

_outtext  ("Press  <Enter>  to  return  to  main  menu."); 
gets  (string) ; 


break; 


case  ZUPT_2_KNOWN_BASES_M2 : 

fprintf  (log_ptr,  ''\n\n\n\n\t\t\tZUPT  W/2  BASES  (M2)\n"); 

_setbkcolor  ( (long)  0) ; 

~clearscreen  (_GCLEARSCREEN) ; 

~setbkcolor  ( (long)  1) ; 

_settextcolor  ((short)  15); 

_settextposition  (center_row,  center_col  -  11) ; 

_outtext  ("Enter  number  of  runs;  '•)  ; 

gets  (string) ; 

numb_runs  =  atoi  (string) ; 

p__err  *  0.0; 
p_err_sum  =  0.0; 
p_err_sq_sxam  =  0.0; 
max_err  =  0.0; 

for  (i_cnt  =  0;  i_cnt  <  nuinb_runs;  ++i_cnt) 

{ 

p_err  =  exper_6  () ; 

p_err_sum  =  p_err_sum  +  p_err; 

p_err_sq_sum  =  p_err_sq_sum  +  p_err*p_err; 

if  (fabs (max_err)  <  fabs(p_err)) 

{ 

max_err  =  p_err; 

} 

} 

p__err_avg  «  p_err_sum/ ( (double)  nuinb_runs)  ; 
p~err_sq_avg  =  p_err_sq_sum/ ( (double)  numb_runs) ; 

_clearscreen  (_GCLEARSCREEN) ; 

_settextposition  (1,  center_col  -  10) ; 

_outtext  C'ZUPT  W/2  BASES  (M2)"); 

_settextposition  (3,  1) ; 

sprintf  (string, 

"Mean  Error  =  %l2.4g  (inches)  STD  =  %l2.4g  (inches) 
p_err_avg , 

sqrt  (p_err_sc[_avg  -  p_err_avg*p_err_avg) )  ; 

_outtext  (string) ; 

sprintf  (string,  "\nMax  Error  =  %12.4g  (inches)",  max_err) ; 
_outtext  (string) ; 

sprintf  (string,  "\nSainpling  rate  =  %g  (Hz)",  samp_freq)  ; 
_outtext  (string) ; 

sprintf  (string,  "\nFilter  bandwidth  =  %g  (Hz)",  f_band) ; 
_outtext  (string) ; 

sprintf  (string,  "\nA-to-D  Range  =  %g  (Gs)",  ad_range) ; 
_outtext  (string) ; 

sprintf  (string,  "\nIntegration  method  =  %d  ",  integ_alg) ; 
_outtext  (string) ; 


(inches)  '• , 


_outtext  (''\n  (0-Simp  1-Trap  2-Adam)"); 

sprintf  (string,  ”\nNumber  of  runs  =  %d  ”,  numb_runs) ; 
_outtext  (string) ; 

fprintf  (log_ptr, 

”\n\nMean  Error  =  %12.4g  (inches)  STD  =  %12. 

p_err_avg, 

sqrt(p_err_sq_avg  -  p_err_avg*p_err_avg) ) ; 
fprintf  (log_ptr,  ”\nMax  Error  =  %12.4g  (inches)”,  max_err) ; 
fprintf  (logjptr,  ”\nSampling  rate  =  %g  (Hz)",  samp_freq) ; 
fprintf  (log_ptr,  ”\nFilter  bandwidth  =  %g  (Hz)”,  f_band) ; 
fprintf  (logjptr,  "\nA-to-D  Range  =  %g  (Gs)”,  ad_range) ; 
fprintf  (log_ptr,  "\nIntegration  method  =  %d  ",  integ_alg) ; 
fprintf  (log_ptr,  "\n  (0-Simp  1-Trap  2-Adam)"); 

fprintf  ^og_ptr,  "\nNumfaer  of  runs  =  %d  ",  numb_runs) ; 

_settextposition  (center_row+2,  center_col  -  19) ; 

_outtext  ("Press  <Enter>  to  return  to  main  menu."); 
gets  (string) ; 


break; 


case  RETURN_FROM_EXP: 
break ; 

) 

break; 

case  FREE_RUN; 

free__run_mode  ()  ; 
break;”" 

case  QUIT  : 

_setvideomode  (_DEFAULTMODE) ; 
exit(O) ; 
break; 

} 

_setbkcolor  ((long)  0); 

_clearscreen  (_GCLEARSCREEN) ; 

) 

while  (1) ; 

) 


void  calibrate_AD1170  (void) 

{ 

char 

string [80] ; 

int 

k,  delay_cnt; 
double 

adc_double_a,  adc_double_b; 

outp  (CNTR_STOP,  0X0000) ; 

_setbkcolor  ((long)  1); 
_settextcolor  ((short)  15); 


_clear screen  (_GCLEARSCREEN) ; 

_settextposition  (l,  1); 

_outtext  ("Apply  +5  volt  reference  to  EXT  INPUT."); 

_settextposition  (2,  1); 

_outtext  ("Press  <Enter>  when  ready."); 

gets  (string) ; 

/*  Setup  AC5004  */ 

y ******* ******************************************************* **y 

wait_for_A  () ; 

outp  (COMMAND_REG_A,  RST) ; 

wait_f or_A  ( ) ; 

outp  (COMMAND_REG_A,  SDI  1  INTEG_167_M)  ; 
wait_for_A  () ; 

outp  (COMMAND_REG_A,  SDC  (  INTEG_300_M)  ; 
wait_for_A  () ; 

outp  (PARAM_1_REG_A,  OxOOOf) ; 
outp  (COMMAND_REG_A,  SDF) ; 

wait_f or_A  ( ) ; 

outp  (COMMAND_REG_A,  NULDI) ; 

wait_for  B  () ; 

outp  (COMMAND_REG_B,  RST)  ; 

wait_f or_B  ( ) ; 

outp  (COMMAND_REG_B,  SDI  ]  INTEG_167_M)  ; 
wait_for_B  ()  ; 

outp  (COMMAND_REG_B,  SDC  |  INTEG_300_M)  ; 
wait_for_B  (); 

outp  (PARAM_1_REG_B,  OxOOOf) ; 
outp  (COMMAND_REG_B,  SDF)  ; 

wait_for_B  () ; 

outp  (COMMAND_REG_B,  NULDI) ; 

wait_for_A  () ; 

outp  (COMMAND_REG_A,  ECAL) ; 

wait_for_B  (); 

outp  (COMMAND_REG_B,  ECAL) ; 

wait_for_A  () ; 

outp  (COMMAND_REG_A,  SCAL) ; 

wait_for_B  (); 

outp  (COMMAND_REG_B,  SCAL) ; 

wait_for_A  () ; 
wait_for_B  (); 

_settextposition  (4,  1); 

_outtext  ("Now  adjust  EXT  INPUT  to  '2  volts."); 


_settextposition  (5,  1) ; 

_outtext  ("Press  <Enter>  when  ready."); 

gets  (string) ; 

_clearscreen  (_GCLEARS GREEN) ; 

_settextposition  (1,  12) ; 

_outtext  ("  Results  of  Calibration  ") ; 

for  (k  =  0;  k  <  10;  ++k) 

{ 

wait_for_A  () ; 

OUtp  (COMMAND_REG_A,  CNV) ; 

wait_for_B  () ; 

outp  (COMMAND_REG_B,  CNV) ; 

adc_double_a  =  read_A  () ; 
adc_double_b  =  read_B  ( )  ; 

_settextposition  (2  +  k,  1)  ; 

sprintf  (string,  "\nADC#l  =  %13.6g  ADC#2  =  %13.6g  Diff  =  %13.6g", 

adc_double_a,  adc_double_b,  adc_double_a  -  adc_double_b) 
_outtext  (string) ; 

for  (delay_cnt  =  0;  delay _cnt  <  30000;  ++delay_cnt) ; 

} 

_settextposition  (4  +  k,  1)  ; 

"outtext  ("Enter  'S'  to  save  new  A-to-D  scale  factor  to  non-volatile") 

_settextposition  (5  +  k,  1)  ; 

~outtaxt  ("memory  on  AD1170's  :  ") ; 

gets  (string) ; 

if  (string[0]  ==  'S'  1|  stringCO]  ==  's') 

{ 

wait_for_A  () ; 

outp  (COMMAND_REG_A,  SAVA) ; 

wait_f or_B  ( ) ; 

outp  (COMMAND  REG_B,  SAVA) ; 

) 

) 


void  calibrate_QA2000  (void) 
{ 

char 

test_str [ 80] ; 
double 

start  jp,  dist, 
end_p,  caic_p; 


setbkcolor  ((long)  1) ; 
settextcolor  ((short)  15); 


_clearscreen  (_GCLEARSCREEN) ; 

conanand_anorad  ( ” A5 .  '• )  ; 

wait_for  (6.0); 

startup  =  read_position  (); 

bias  *  bias  +  do_zupt  (ZUPT_POINTS) ; 

SF  =  1.0; 

calc_p  «  integrate_and_inove  (4.0, 

''DOODO01881D01FF0O00O000D0FE77E3O0OOOOOOOOG")  ; 

end__p  =  read_position  ()  ; 
dist  =  end_p  -  start_p; 

SF  =  dist/calc_p; 
bias_tiine  =  0.0; 

printf  (''\ndist  =  %g  SF  =  %g  bias  =  %g'',  dist,  SF,  bias)  ; 
gets  (test_str) ; 

) 


void  coininand_anorad  (char  *ano_buffer) 
{ 

int 

i; 


for  (i  =  0;  ano  buffer(i]  1=  '\0*;  ++i) 

( 

_bios  serialcom  (_COM  SEND,  0,  (unsigned  int)  ano  buffer[i]); 


/*  Change  the  cursor  shape. 

<value>  has  starting  line  in  upper  byte,  ending  line  in  lower  byte. 
Returns  the  previous  cursor  value.  */ 

unsigned  cursor  (unsigned  value) 

( 

union  REGS  inregs,  outregs; 
int  ret; 

inregs. h. ah  =3;  /*  Get  old  cursor  */ 

inregs. h.bh  =0; 

int86  (0x10, Sinregs, &outregs) ; 

ret  =  outregs . X . cx ; 

inregs. h. ah  =1;  /*  Set  new  cursor  */ 

inregs. x.cx  =  value; 

int86  (0x10, Sinregs, &outregs) ; 

return  (ret) ; 

) 


/*  Put  an  item  in  menu. 


<row>  and  <col>  are  left  position. 

<str>  is  the  string  item. 

<len>  is  the  number  of  blanks  to  fill.  */ 

/oid  display  menu  item  (int  left_row,  int  left_col,  char  *str,  int  len) 

{ 

char 

temp [80] ; 

_settextposition  (left_row,  left_col) ; 

_outtext  (”  ”) ; 

_outtext  (str) ; 
memset  (temp,  '  '  ,ler. — )  ; 

temp [len]  =  0; 

_outtext  (temp) ; 


double  do_zupt  (int  numb_data_points) 

{ 

int 

i; 

double 

accel_sum; 

accel_sum  =  0.0; 

for  (i  *  0;  i  <  numb_data_points/2 ;  ++i) 

( 

accel_svim  =  accel_sum  +  read_A  ()  -  bias; 
accel_sum  =  accel_sum  +  read_B  ()  -  bias; 

) 

return  (accel_sum/ (double)  numb_data_points) ; 


/*  Draw  menu  box. 

<row>  and  <col>  are  upper  left  of  box. 

<hi>  and  <wid>  are  height  and  width.  */ 

void  draw_menu_box  (int  up_left_row,  int  up_left_col,  int  height,  int  width) 
{ 

int 

i; 

char 

temp [80] ; 

_settextposition  (up_left_row,  up_left_col) ; 

temp[0]  =  *menus.nw; 

memset  (temp  +  1,  *menus.ew,  width); 

temp [width  +  l]  =  *menus.ne; 

temp [width  +  2]  =  0; 

_outtext  (temp) ; 

for  (i  =  1;  i  <=  height;  ++i) 

{ 

_settextposition  (up_left_row  +  i,  up_left_col) ; 

_outtext  (menus. ns) ; 


} 


settextposition  (up_left_row  +  i,  up_left_col  +  width  +  i) ; 
outtext  (menus. ns) ; 


_settextposition  (up_left_row  +  height  +  1,  up_left_col) ; 

temp [ 0 ]  =  *menus . sw ; 

memset  (temp  +  1,  *menus.ew,  width); 

temp [width  +  1]  =  *menus.se; 

temp [width  +2]  =0; 

_outtext  (temp) ; 


double  exper_l  (void) 

{ 

double 

start_p,  end_p,  calc_p,  err,  data_time; 


data_time  =  3.0; 
command_anorad  ( " A5 . ” ) ; 
wait_for  (8.0) ; 

outp  (CNTR_STOP,  0x0000) ;  /*  Disarm  2MCLK  */ 

wait_for_A  () ; 

outp  (COMMAND_REG_A,  SCAL) ; 

wait  for_B  () ; 

outp- ( COMMAND_REG_B ,  SCAL) ; 

wait_f or_A  ( ) ; 
wait_for_B  () ; 

outp  (CNTR_START,  0x0000) ;  /*  Arm  2MCLK  */ 

start_p  =  read_position  (); 

calc_p  =  integrate_and_move  (data_time, 

'•D00D0O1881DO1FFOOOOOOOODOFE77E300OOOOOOOOG'')  ; 

end_p  =  read_position  (); 

err  =  calc_p  -  (endj  -  startup)  ; 

fprintf  (log_ptr,  "\n%14.6g  %14.6g  %14.6g", 

calc_p,  end_p  -  start_p,  err) ; 

return  (err) ; 


double  exper_2  (void) 

{ 

double 

start_p,  end_p,  calc_p,  err,  data_time; 


data_tiine  =  3.0; 
coimand_anorad  ( "AS .  '• )  ; 
wait_for  (8.0); 

outp  (CNTR_STOP,  0X0000) ;  /*  Disarm  2MCLK  */ 

wait_for_A  () ; 

outp  (COMMAND_REG_A,  SCAL) ; 

wait_for_B  (); 

outp  (COMMAND_REG_B,  SCAL) ; 

wait_for_A  ( ) ; 
wait_f or_B  ( ) ; 

outp  (CNTR_START,  0x0000)  ;  /*  Arm  2MCLK  */ 

start_p  =  read_position  () ; 

bias  =  bias  +  do_2upt  (ZUPT_POINTS) ; 

calc_p  =  integrate_and_move  (data_time, 

"D00D001881D01FF000O000OD0FE77E3O0O0OOOOO0G'')  ; 

wait_for  (2.0); 

bias  =  bias  +  do_zupt  (ZUPT_POINTS) ; 
calcjp  =  calc_p  + 

integrate  and_move  (data_time, 

''D00D0O1881D01FF0O0000O0D0FE77E300O0O0OOOOG'*)  ; 

wait_for  (2.0); 

bias  =  bias  +  do_zupt  (ZUPT_POINTS) ; 
calc_p  =  calc_p  + 

integrate_and_move  (data_tiine, 

''D00D001881D01FF00000000D0FE77E30000000000G”)  ; 

end_p  =  read_position  (); 

err  =  calc_p  -  (endjp  -  start_p) ; 

fprintf  (log_ptr,  "\n%14.6g  %14.6g  %14.6g", 

calc_p,  end_p  -  start_p,  err) ; 

return  (err) ; 


double  exper_3  (void) 

{ 

double 

start_p,  end_p,  calc_p,  err,  data_time,  vel_suin; 
data_time  =  3.0; 
coitimand_anorad  ( ”A5 .  " )  ; 


wait_for  (8.0); 

outp  (CNTR_STOP,  0x0000) ;  /*  Disarm  2MCLK  */ 

wait_for_A  ()  ; 

outp  (COMMAND_REG_A,  SCAL) ; 

wait  for_B  () ; 

OUtp’'(C0MMAND_REG_B,  SCAL)  ; 

wait_for_A  ()  ; 
wait_for_B  ()  ; 

outp  (CNTR_START,  0x0000) ;  /*  Arm  2MCLK  */ 

start__p  =  read_position  (); 

calc_p  =  integrate_and_move  (data_tiine, 

''D00D001881D01FF0000000OD0FE77E30000O0O0OOG’')  ; 
vel_sum  =  vel ; 

wait_for  (2.0); 

calc_p  *  calc_p  + 

integrate__and_move  (data_tiine,  "AS.”); 
vel_sum  =  vel_sum  +  vel ; 

end__p  =  read__position  ()  ; 

err  =  calc_p  -  (end_p  -  start_p) ; 

bias  =  bias  -  (2 . 0*vel_sum/data_time  + 

6 . 0*err/ (data_time*data_time) ) /SF; 

bias_time  =  bias_time  +  (6 . 0*vel_sum/ (data_time*data_time)  - 
12 . 0*err/ (data_time*data_time*data_time) ) /SF ; 

fprintf  (log_ptr,  "\n%l4.6g  %14.6g  %l4.6g", 

calc_p,  end_p  -  startup,  err) ; 

return  (err) ; 


double  exper_4  (void) 

{ 

double 

start  _p,  end_p,  calc_p.,  err,  data_time,  vel_sum; 
data_time  =  3.0; 
coinmand_anorad  ("A5."); 
wait_for  (8.0); 

outp  (CNTR_ST0P,  0x0000) ;  /*  Disarm  2MCLK  */ 

wait_for_A  () ; 

outp  (COMMAND_REG_A,  SCAL) ; 

wait_for_B  () ; 


outp  (COMMAND_REG_B,  SCAL) ; 


wait_for_A  () ; 
wait_for_B  (); 

outp  (CNTR_START,  0x0000)  ;  /*  Arm  2MCLK  */ 

start_p  =  read_position  () ; 

calc_p  =  integrate_and_move  (data_time, 

"D00D001881D01FF00000000D0FE77E30000000000G")  ; 
vel_sum  =  vel; 

wait_for  (2.0); 

calc_p  =  calc_p  + 

integrate_and_move  (data_tiine,  "AS.”); 
vel_sum  =  vel_sum  -r  vel ; 

end_p  =  read_position  (); 

err  =  calc_p  -  (end_p  -  startjp) ; 

bias  =  bias  -  (2 . 0*vel_sum/data_time  + 

6. 0*err/ (data_time*data_time) )/SF; 

bias_tiine  =  bias_tiine  +  (6.0*vel_sum/ (data_time*data_time) 

12 . 0*err/  (data_tiirie*data_tiine*data_time)  )/SF; 

fprintf  (log_ptr,  ''\n%14.6g  %14.6g  %14.6g", 

calc_p,  end_p  -  start_p,  err) ; 

return  (err) ; 

) 


double  exper_5  (void) 

{ 

double 

startjp,  end_p,  calcjp,  err,  data_time,  vel_sum; 
data_time  *  3.0; 
coTninand_anorad  ( "A5 .  ” )  ; 
wait_for  (8.0); 

outp  (CNTR_STOP,  0x0000) ;  /*  Disarm  2MCLK  */ 

wait_for_A  (); 

outp  (COMMAND_REG_A,  SCAL) ; 

wait_for_B  () ; 

outp  (COMMAND_REG_B,  SCAL) ; 

wait_for_A  (); 
wait_for_B  (); 

outp  (CNTR_START,  0x0000) ;  /*  Arm  2MCLK  */ 

startjp  =  read_position  (); 


calc_p  =  integrate_and_inove  (data_time, 

''DOOD001881D01FFOOOOOOOODO’'  ■:77E30000000000G'' )  ; 
vel_suia  =  vel; 

wait_for  (2.0); 

calc_p  =  calc_p  + 

integrate_and_move  ( data_t ime , 

••DOOD0O1881DO1FF000OO000D0FF7  7E30000O000OOG”)  ; 
vel_sum  =  vel_suia  +  vel; 

end_p  =  read_position  (); 

err  =  calc_p  -  (end_p  -  start_p) ; 

bias  =  bias  -  (2 . 0*vel_sum/data_time  + 

5. 0*err/  (data_tiine*data_time)  )/SF; 

bias_tiine  =  bias_time  +  (6. 0*vel_svun/ (data_tiine*data_time) 

12 . 0*err/  (data_tiine*data_tiine*data_time)  )/SF; 

SF  =  SF*end_p/calc_p; 

fprintf  (log_ptr,  "\n%14.6g  %l4.6g  %14.6g", 

calc_p,  end_p  -  start_p,  err) ; 

return  (err) ; 

} 


double  exper_6  (void) 

{ 

double 

start_p,  end_p,  calc_p,  err,  data_tiine; 
data_tiine  =  3.0; 
coininand_anorad  ( "  A5 .  " )  ; 
wait_for  (8.0); 

outp  (CNTR_ST0P,  0x0000) ;  /*  Disarm  2MCLK  */ 

wait_for_A  ()  ; 

outp  (COMMAND_REG_A,  SCAL) ; 

wait_for_B  () ; 

outp  (COMMAND_REG_B,  SCAL) ; 

wait_for_A  () ; 
wait_for_B  () ; 

outp  (CNTR_START,  0x0000) ;  /*  Arm  2MCLK  */ 

start_p  =  read_position  (); 

bias  =  bias  +  do_zupt  (ZUPT_POINTS) ; 

calc_p  =  integrate_and_move  (data_tiine, 

"D00D001881D01FF00000000D0FE77E30000000000G") ; 

wait_for  (2.0)  ; 


bias  =  bias  +  do_zupt  (ZUPT_POINTS) ; 
calc_p  *  calc_p  + 

integrate_and_move 

''DOODOO1881DO1FFOOOO0OOODOFE77E30OOOOOOOOOG'')  ; 

end_p  =  read_position  ()  ; 

err  *  calc_p  -  (endjp  -  start_p) ; 

SF  *  (SF  +  SF*end_p/calc_p)/2.0; 

fprintf  (log_ptr,  "\n%l4.6g  %14.6g  %14.6g'', 

calc_p,  end__p  -  start_p,  err)  ; 


return  (err) ; 

} 


(data_time. 


void  free_run__mode  (void) 

{ 

char 

string  [80] ; 

int 

in_char ; 

unsigned  int 
ret; 

double 

accel_inl,  accel_in2,  accel_ra3,  accel,  position,  d_cnt, 
vel_inl,  vel_ia2,  vel_m3 ,  tot_tiine,  p_correct,  ~ 
new_bias,  slope; 


_setbkcolor  ((long)  1) ; 
_settextcolor  ((short)  15); 
_clearscreen  (_GCLEARS GREEN) ; 

accel_ial  *  0.0; 
accel_m2  =  0.0; 
accel_in3  =  0.0; 
accel  *  0.0; 

vel_ml  =  0.0; 
vel_m2  =  0.0; 
vel_in3  =  0.0; 
vel  =  0 . 0 ; 

d_cnt  =  0.0; 

position  =  read_position  (); 
do 

{ 

if  (kbhitO  !=  0) 

( 


in_char  =  getch  () ; 
if  (in_char  ==  (int)  •*') 


{ 


return ; 

) 

if  (in_char  ==  (int)  '2') 

{ 

new_bias  =  bias  +  do_2upt  ( ZUPT_POINTS ) ; 

tot_time  =  d_cnt*dt*2 . 0; 

slope  =»  SF*(new_bias  -  bias)/tot_time; 

p_correct  =  slope*tot_time*tot_time*tot_time/6. 0 ; 

position  =  position-p_correct; 

bias  =  new_bias; 

d_cnt  *  0.0; 

accel_inl  =  0.0; 
accel_iti2  =  0.0; 
accel_m3  =  0.0; 
accel  =  0.0; 

vel_ml  =  0.0; 
vel_in2  =  0.0; 
vel_in3  =  0.0; 
vel  =  0.0; 

} 

else 

{ 

ret  =  _bios  serialcom  (_COM_SEND,  0,  (unsigned  int)  in_char) ; 
} 


accel_in3  *  accel_ni2; 
accel~in2  =  accel_inl; 
accel_ial  =  accel; 
accel  =  SF*(read__A  ()  -  bias); 

vel_in3  =  vel_ni2 ; 
vel_in2  =  vel_TOl; 
vel_inl  =  vel; 

switch  (integ_alg) 

( 

case  SIMP: 

vel  =  vel  +  (5.0*accel  +  8. 0*accel_ial  -  accel_m2)  *dt_12 ; 
position  =  position  +  (5.0*vel  +  8.0*vel_ml  -  vei_in2)  *dt_12 
break; 

case  TRAP: 

vel  ==  vel  +  (accel  +  accel_ml)  *dt_2 ; 
position  =  position  +  (vel  +  vel_inl)  *dt_2 ; 
break; 

case  ADAM: 

vel  =  vel  +  (55.0*accel  -  59 . 0*accel_inl  + 

37 . 0*accel_in2  -  9 . 0*accel_in3 )  *dt_24  ; 
position  =  position  +  (55.0*vel  -  59.0*vel_inl  + 

37.0*vel_in2  -  9 . 0*vel_in3)  *dt_24  ; 

break; 

) 

accel_in3  =  accel_m2  ; 
accel_in2  =  accel_ml ; 
accel  ml  =  accel; 


accel  =  SF*(read_B  ()  -  bias); 


vel_m3  =  vel_m2; 
vel_m2  =  vel_ml; 
vel_inl  =  vel; 

switch  (integ_alg) 

( 

case  SIMP: 

vel  =  vel  +  (5.0*accel  +  8.0*accel_njl  -  accel_m2)  *dt_12 ; 
position  =  position  +  (5.0*vel  +  8.0*vel_inl  -  vel_iii2)  *dt_12  ; 
break ; 

case  TRAP: 

vel  =  vel  +  (accel  +  accel_ml) *dt_2 ; 
position  =  position  +  (vel  +  vel_inl)  *dt_2 ; 
break ; 

case  ADAM: 

vel  =  vel  +  (55.0*accel  -  59.0*accel_ml  + 

37 . 0*accel_m2  -  9 . 0*accel_m3 ) *dt_24 ; 
position  =  position  +  (55.0*vel  -  59-0*vel_Tnl  + 

37.0*vel_in2  -  9 . 0*vel_in3 )  *dt_24  ; 

break; 

} 

sprintf  (string,  "Position  =  %12.3f  inches",  position) ; 
__settextposition  (center_row,  center_col  -  16)  ; 

__outtext  (string)  ; 

d  cnt  =  d  cnt  +  1.0; 

T 

while  (1) ; 


double  Integra te_and_inove  (double  seconds,  char  *ano_buffer) 
{ 

int 

string_len,  i,  k,  numb_points; 
double 

accel_inl,  accel_in2,  accel_in3,  accel,  position, 
vel_ml ,  vel_in2  ,  vel_m3  ; 


_setbkcolor  ((long)  1); 
_settextcolor  ( (short)  15)  ; 
_clearscreen  (_GCLEARS GREEN) ; 

string_len  =  strlen  (ano_buffer) ; 
k  =  0; 

numb_points  =  (int)  (seconds/dt) ; 

accel_ml  =  0.0; 
accel_in2  =  0.0; 
accel_m3  =  0.0; 
accel  =  0.0; 

vel_ml  =  0.0; 
vel  m2  =  0.0; 


vel_m3  «  0.0; 
vel  =  0.0; 

position  =  0.0; 

for  (i  «  0;  i  <  nuitib_points/2 ;  ++i) 

{ 

accel_m3  =  accel_in2 ; 
accel_in2  =  accel_ml; 
accel_inl  =  accel; 

accel  =  SF*(read_A  ()  -  bias  -  bias_time*dt*i) ; 

vel_m3  =  vel_Tn2 ; 
vel_in2  *  vel_inl; 
vel_inl  =  vel; 

switch  (integ_alg) 

{ 

case  SIMP: 

vel  *  vel  +  (5.0*accel  +  8.0*accel_ml  -  accel_ni2 )  *dt_12 ; 
position  =  position  +  (5.0*vel  +  8.0*vel_ml  -  vel_m2 ) *dt_12 
break ; 

case  TRAP: 

vel  =  vel  +  (accel  +  accel_iQl)  *dt_2 ; 
position  =  position  +  (vel  +  vel_ml) *dt_2 ; 
break ; 

case  ADAM: 

vel  =  vel  +  (55.0*accel  -  59. 0*accel_ml  + 

37 . 0*accel_ia2  -  9 . 0*accel_m3)  *dt_24 ; 
position  »=  position  +  (55.0*v6l  -  59.0*vel  ml  + 

37.0*vel_m2  -  9.0*vel_m3) *dt_24; 

break ; 

) 

accel_in3  =  accel_m2 ; 
accel_in2  =  accel_ml ; 
accel_inl  =  accel; 

accel  =  SF*(read_B  ()  -  bias  -  bias_time*dt*i)  ; 

vel_in3  =  vel_m2  ; 
vel_m2  =  vel_ml; 
vel_ml  =  vel; 

switch  (integ_alg) 

{ 

case  SIMP: 

vel  =  vel  +  (5.0*accel  +  8.0*accel_ml  -  accel_m2 ) *dt_12 ; 
position  =  position  +  (5.0*vel  +  8.0*vel_ml  -  vel_in2 )  *dt_12 
break; 

case  TRAP: 

vel  =  vel  +  (accel  +  accel_inl)  *dt_2 ; 
position  =  position  +  (vel  +  vel_ml) *dt_2 ; 
break; 

case  ADAM: 

vel  =  vel  +  (55.0*accel  -  59 . 0*accel_ml  + 

37 . 0*accel_m2  -  9. 0*accel_m3) *dt_24  ; 
position  =  position  +  (55.0*vel  -  59.0*vei_ml  + 

37.0*vel_Tn2  -  9 . 0*vel_Tn3 )  *dt_2  4  ; 


break; 


) 


if  (k  <  string_len) 

{ 

_bios_serialcoin  (_COM_SEND,  0,  (unsigned  int)  ano_buf fer [k] ) 

++kT 

) 

} 

return  (position) ; 

} 


/*  Put  menu  on  screen. 

Starting  <row>  and  <column>. 

Array  of  menu  <items>  strings. 

Global  structure  variable  <menus>  determines: 

Colors  of  border,  normal  items,  and  selected  item. 

Centered  or  left  justfied. 

Border  characters. 

Returns  number  of  item  selected-  */ 

int  get_menu  (int  row,  int  col,  char  *  *items) 

{ 

int 

i,  numb_items,  max  *  2,  prev,  curr  =  0, 
litem (25] ; 

long 

bcolor; 

cursor  (TCURSOROFF) ; 
bcolor  =  _getbkcolor  ()  ; 

/*  Count  items,  find  longest,  and  put  length  of  each  in  array  */ 

for  (numb_items  =  0;  items [numb_i terns]  1=  NULL;  numb_items++) 

{ 

litem[numb_items]  =  strlen  ( items ( numb_items ]) ; 
if  (max  <  litem[numb_items] ) 
max  =  litem[numb_items] ; 

} 

max  =  max  +  2 ; 

if  (menus. centered) 

{ 

row  -=  numb_items  /  2 ; 
col  -=  max  /  2; 


/*  Draw  menu  box  */ 

_settextcolor  (menus. fgBorder)  ; 

_setbkcolor  (menus. bgBorder)  ; 
draw_menu_box  (row++, col++, numb_items,max) ; 

/*  Put  items  in  menu  */ 

for  (i  =  0;  i  <  numb_items;  ++i) 

{ 

if  (i  ==  curr) 

{ 


_settextcolor  (menus. fgSelect) ; 

_setbkcolor  (menus. bgSelect) ; 

} 

else 

{ 

_settextcolor  (menus. fgNormal) ; 

_setbkcolor  (menus. bgNormal) ; 

} 

display_menu_item  (row+i,col, items [i] , max  -  litem[i]); 

} 

/*  Get  selection  */ 

for  (;;) 

{ 

switch  ( (_bios_keybrd(_KEYBRD_READ)  &  OxffOO)  »  8) 

{ 

case  UP  : 

prev  =s  curr; 

curr  =  (curr  >0)  ?  ( — curr  %  numb_items)  :  numb_items-l ; 
break ; 

case  DOWN  : 
prev  *  curr; 

curr  =  (curr  <  numb_items)  ?  (++curr  %  numb_items)  :  0; 
break; 

case  ENTER  : 

_setbkcolor  (bcolor) ; 
return  (curr) ; 

default  : 
continue; 

} 

_settextcolor  (menus. fgSelect) ; 

_setbkcolor  (menus. bgSelect) ; 

display_menu_itera  (row  +  curr,  col,  items[curr],  max  -  litem[curr]) 

_settextcolor  (menus . fgNormal ) ; 

_setbkcolor  (menus. bgNormal) ; 

display_menu_item  (row  +  prev,  col,  items [prev],  max  -  litem [prev]) 

) 

) 


double  read_A  ( ) 

{ 

int 

high_byte,  mid_byte,  low_byte,  status_byte; 
long  int 

h_byte,  m_byte,  l_byte,  adc_result; 

double 

adc_double; 

do 

{ 

status  byte  =  inp  (STATUS_REG_A) ; 

} 

while  ( (status_byte  &  0x0002)  ==  0x0000); 


/****************************************************************/ 
/*  Read  low,  mid  and  high  bytes  */ 

/****************************************************************/ 


high_byte  «  inp  (HIGH_DATA_A) ; 
mid_byte  =  inp  (MID_DATA_A) ; 
low_byte  «  inp  (LOW_DATA_A) ; 

/*  Combine  bytes  */ 

y/****************************************************************/ 

h_byte  =  (long  int)  high^byte; 

m_byte  =  (long  int)  mid_byte; 

l_byte  =  (long  int)  low_byte; 

adc_result  =  ( (h_byte  <<  16)  &  OxffffOOOO)  | 

( (m_byte  <<  8)  &  OxOOOOffOO)  \ 

^_byte  &  OxOOOOOOff)  ; 

adc_double  =  (10.0*adc_result)/4194304.0  -  5.0; 
return  (adc_double) ; 


double  read_B  ( ) 

( 

int 


high_byte, 

long  int 
h_byte, 


mid_byte , 
m_by te , 


double 

adc  double; 


low_byte ,  status__by  te ; 
l_by te ,  adc_result ; 


do 

{ 

status_byte  =  inp  (STATUS_REG_B) ; 

} 

while  ( ( status_by te  &  0x0002)  ==  0x0000); 

/****************************************************************/ 
/*  Read  low,  mid  and  high  bytes  */ 

/************************************************************•****/ 

high_byte  =  inp  (HIGH_DATA_B) ; 
mid_byte  =  inp  (MID_DATA_B) ; 
low_byte  =  inp  (LOW_DATA_B) ; 

/****************************************************************/ 
/*  Combine  and  store  in  array  */ 

/****************************************************************/ 

h_byte  =  (long  int)  high_byte; 

m_byte  =  (long  int)  mid_byte; 

l_byte  =  (long  int)  low_byte; 

adc_result  =  ( (h_byte  <<  16)  &  OxffffOOOO)  | 

((m_byte  <<  8)  &  OxOOOOffOO)  [ 

(l_byte  &  OxOOOOOOff); 

adc_double  =  ( 10. 0*adc_result)/4 194304.0  -  5.0; 


return  (adc_double) ; 


double  read_position  () 

( 

unsigned  int 

conl_ret,  coml_retl,  coTnl_ret2,  coinl_ret3,  coinl_ret4, 

conil_ret5 , 

coml_ret6 ,  coml_ret7 ; 

double 

posi ; 

do 

{ 

coml_ret7  =  _bios_serialcom  (_COM_RECEIVE ,  0,  0) ; 
coml_ret7  =  _bios_serialcom  (_COM_RECEIVE,  0,  0)  ; 
coml_ret7  =  _bios_serialcora  (_COM_RECEIVE,  0,  0)  ; 

coinl_ret  =  _bios_serialcoin  (_C0M_SEND,  0,  (unsigned  int)  'Q'); 

coinl_retl  =  _bios_serialcom  (_COM_RECEIVE,  0,  0)  ; 
coinl_ret2  *  _bios_serialcoiQ  (_COM_RECEIVE,  0,  0)  ; 
coml_ret3  =  _bios_serialcom  (_COM_RECEIVE,  0,  0)  ; 
coml_ret4  =  _bios_serialcoiti  (_COM_RECEIVE,  0,  0)  ; 
coinl_ret5  =  __bios_serialcom  (~COM_RECEIVE ,  0,  0)  ; 
coml__ret6  =  ~bios_serialcom  (_COM_RECEIVE ,  0,  0)  ; 
coinl~ret7  =  ~bios_serialcom  (”C0M__RECEIVE ,  0,  0)  ; 

if  (coinl_retl  <  65) 

{ 

posi  =  1048576.0  *  ((double)  coinl  retl  -  48); 

) 

else 

{ 

posi  =  1048576.0  *  ((double)  coial_retl  -  55); 

} 

if  (coinl_ret2  <  65) 

{ 

posi  =  posi  +  65536.0  *  ((double)  conil_ret2  -  48); 

} 

else 

{ 

posi  =  posi  +  65536.0  *  ((double)  coinl_ret2  -  55); 

} 

if  (coml_ret3  <  65) 

{ 

posi  =  posi  +  4096.0  *  ((double)  coTnl_ret3  -  48); 

} 

else 

{ 

posi  =  posi  +  4096.0  *  ((double)  coinl_ret3  -  55); 

} 

if  (coinl_ret4  <  65) 

{ 

posi  =  posi  +  256.0  *  ((double)  coml_ret4  -  48); 


} 


else 

{ 

posi  =  posi  +  256.0  *  ((double)  coml_ret4  -  55) 

} 

if  (coml_ret5  <  65) 

{ 

posi  *  posi  +  16.0  *  ((double)  coml_ret5  -  48); 

) 

else 

{ 

posi  =  posi  +  16.0  *  ( (dotible)  coml_ret5  -  55); 

} 

if  (coml  ret6  <  65) 

{ 

posi  =  posi  +  1.0  *  ((double)  coinl_ret6  -  48); 

} 

else 

{ 

posi  =  posi  +  1.0  *  ((double)  cojttl_ret6  -  55); 

} 

posi  -  posi/64000. 0; 

} 

while  (posi  >  12.0  j]  posi  <  0.0); 
return  (posi) ; 

} 


void  setup_ADC_de faults 

{ 

wait_for_A  (); 
outp  (COMMAND_REG_A, 

wait_for_A  (); 
outp  (COMMAND_REG_A, 

wait_for_B  () ; 
outp  (COMMAND_REG_B, 

wait_for_B  () ; 
outp  (COMMAND_REG_B, 

wait_for_A  () ; 
outp  (PARAM_1_REG_A, 
outp  (COMMAND_REG_A, 

wait_for_B  () ; 
outp  (PARAM_1_REG_B, 
outp  (COMMAND_REG_B, 

wait_for_A  () ; 
outp  (COMMAND_REG_A, 

wait_for_A  () ; 
outp  {COMMAND_REG_A, 

wait_for_A  () ; 
outp  (COMMAND_REG_A, 


(void) 


RST)  ; 

SDC  I  INTEG_300_M) ; 
RST)  ; 

SDC  I  INTEG_300_M) ; 

OxOOOf ) ; 

SDF)  ; 

OxOOOf)  ; 

SDF)  ; 

CALDI)  ; 

NULDI)  ; 

SCAL)  ; 


void  setup_anorad  (void) 

{ 

unsigned  int 
coml  ret; 


coml_ 

_ret 

bios 

serialcom 

(  COM 

INIT, 

0, 

- 

_COM_9600  1  _C0M_ 

EVENPARITY 

_ 

COM_CHR7  1 

_COM_ 

_STOP2 

coinl_ 

_ret 

= 

_bios_ 

serialcom 

1 

O 

O 

2 

_SEND, 

0, 

1) ; 

coinl_ 

_ret 

= 

_bios_ 

serialcom 

(  COM 

SEND, 

0, 

(unsigned 

int) 

•M' 

)  ; 

coml 

ret 

_bios_ 

_serialcom 

(  com' 

'send. 

0, 

(unsigned 

int) 

'H' 

)  ; 

coml 

"ret 

= 

_bios_ 

serialcom 

(  com" 

'send, 

0, 

(unsigned 

int) 

•2* 

)  ; 

coml 

"ret 

= 

_bios_ 

[serialcom 

(  com" 

'send, 

0, 

(unsigned 

int) 

151 

)  ; 

coml 

_ret 

s 

_bios_ 

[serialcom 

(  com" 

'send. 

0, 

(unsigned 

int) 

•6' 

) ; 

coml 

_ret 

= 

_bios_ 

_serialcom 

(_com' 

[send, 

0, 

(unsigned 

int) 

1  ^  1 

)  ; 

coml 

_ret 

= 

_bios_ 

serialcom 

(_C0M_ 

_SEND, 

0, 

(unsigned 

int) 

'H' 

)  ; 

coml 

ret 

_bios_ 

serialcom 

(  COM 

SEND, 

0, 

(unsigned 

int) 

'E' 

)  ? 

coml 

“ret 

= 

_bios_ 

_serialcom 

(  com' 

'send, 

0, 

(unsigned 

int) 

•1' 

) ; 

coml 

_ret 

= 

_bios_ 

_serialcom 

(_com[ 

[send. 

0, 

(unsigned 

int) 

1  1 

) ; 

coml 

_ret 

s 

_bios_ 

_serialcom 

(  COM 

SEND, 

0, 

(unsigned 

int) 

■  F' 

)  ; 

coml 

_ret 

= 

_bios_ 

_serialcom 

(  com' 

'send. 

0, 

(unsigned 

int) 

'2  ' 

)  ; 

coml 

_ret 

=: 

_bios_ 

serialcom 

(  com' 

'send. 

0, 

(unsigned 

int) 

•  0  ' 

)  ; 

coml 

_ret 

_bios_ 

_serialcom 

(  com' 

'send. 

0, 

(unsigned 

int) 

'  0  ' 

)  ; 

coml 

_ret 

= 

_bios_ 

serialcom 

(_com' 

[send. 

0, 

(unsigned 

int) 

1  ( 
• 

)  ? 

coml 

_ret 

35 

_bios_ 

_scrialcom 

(  COM 

SEND, 

0, 

(unsigned 

int) 

•M' 

)  ; 

coml 

"ret 

= 

_bios~ 

[serialcom 

(  com' 

'send. 

0, 

(unsigned 

int) 

•A' 

) ; 

coml 

"ret 

= 

~bios_ 

[serialcom 

(  com' 

'send. 

0, 

(unsigned 

int) 

•5* 

)  ? 

coml 

_ret 

_bios_ 

[serialcom 

(_C0M_ 

'send. 

0, 

(unsigned 

int) 

I  V 

• 

)  ? 

coml 

_ret 

= 

_bios_ 

serialcom 

(  COM 

RECEIVE, 

0,  0)  ; 

coml 

_ret 

_bios]^ 

_serialcom 

(  com' 

■receive. 

0,  0)  ; 

coml 

"ret 

= 

_bios_ 

_serialcom 

(  com' 

■receive  , 

0,  0)  ; 

double  setup_counter  (double  frequency) 

{ 

unsigned  int 

nunib_counts ,  chigh,  clow; 

double 

actual_freq; 

/*************************************************************/ 

/*  Program  counters  on  ADC  board  */ 

/*************************************************************/ 

nuinb_counts  =  (unsigned  int)  (2  .  OE+06/frequency)  ; 
chigh  =  (nuinb_counts  >>  8)  &  OxOOff; 
clow  =  numb_counts  &  OxOOff; 

outp  (CNTR_STOP,  0x0000) ; 
outp  (CNTR_LOW_BYTE,  clow) ; 
outp  (CNTR_HIGH_BYTE,  chigh) ; 


actual_freq  =  2  .  OE+06/ ( (double)  nui[ib_counts)  ; 
return  (actual_freq) ; 


void  wait_for  (double  seconds) 

{ 

char 

string [80] ; 


int 

i ,  nunib_points ; 

double 

input ; 


_setbkcolor  ((long)  1); 

_settextcolor  ((short)  15); 

_clearscreen  (__GCLEARSCREEN)  ; 

_settextposition  (center_row,  center_col  -  15) ; 
sprintf  (string,  "Waiting  for  %10.2g  seconds",  seconds); 
_outtext  (string) ; 

numbjpoints  =  (int)  (seconds/dt) ; 

for  (i  =  0;  i  <  nuiabjpoints/2 ;  ++i) 

{ 

input  *  read_A  ( ) ; 
input  *  read  B  () ; 

) 

} 


void  wait_f or_A  ( ) 

{ 

unsigned  int 
status_word ; 

do 

{ 

status_word  =  inp  (STATUS_REG_A) ; 

) 

while  ( ( status_word  &  0x0001)  ==  1  | |  (status_word  &  0x0020) 

} 


void  wait_for_B  () 
{ 

unsigned  int 
status  word; 


=  0x0020) ; 


do 

{ 


status_word  =  inp  (STATUS_REG_B) ; 

while  ( ( status_word  &  0x0001)  ==  1  | |  (status^word  &  0x0020)  ==  0x0020) 

} 
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lAC  PROGRAMMING  CODES  EXPLANATION 


Command 

Descr int ions 

PAGE 

— 

A 

Absolute  Position 

2-2 

- 

D 

Acceleration  Data 

2-3 

- 

E 

Set  Early  Peady  Distance 

2-3 

-• 

F 

Set  Maximum  Velocity 

2-4 

- 

I 

Incremental  Position 

2-4 

- 

0 

Home  Offset 

2-4 

G 

Interpolation 

2-5 

— 

P 

Point-To-Point  Mode 

2-5 

J,R 

Servo  Off 

2-5 

— 

H 

Home 

2-6 

Z 

Zero  Set  (reset) 

2-6 

M 

Select  Variable  Axis  Parameters 

2-7 

- 

MA 

Select  Square  Root  Deceleration 

2-7 

MB 

Set  Velocity  Bias 

2-8 

MC 

Tach  switching  systems  only 

2-9 

MD 

Set  home  search  distance 

2-9 

MF 

Set  DAC  Bias  Compensation 

2-9 

MG 

Interpolation  Error  Gain 

2-9 

MH 

Set  Home  Speed 

2-10 

MI 

Desired  Velocity  (Interpolation)  Scale  Factor 

2-10 

MP 

Select  Linear  Deceleration  Slope 

2-11 

- 

Q 

Output  Position 

2-12 

U 

Enable  Synchronized  Ready  Mode 

2-12 

V 

Disable  Synchronized  Ready  Mode 

2-12 

- 

v; 

Output  Status 

2-13 

- 

X 

Abort  Command  Execution 

2-16 

Y 

Abort  Command  Execution 

2-15 

2-1 
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This  section  contains  detailed  descriptions  of  all  commands, 
'^hese  fall  into  two  groups;  Buffered  (non-imned iate )  and 
Mon-Buffered  (immediate). 


Buffered  Commands 

The  following  commands  are  stored  by  the  axis;  they  are  executed  in 
sequence  immediately  following  the  completion  of  the  previous 
command  (see  Enable  Synchronized  Ready  command  page  2-12  for  more 
information).  A.11  require  that  the  axis  be  addressed  in  order  to  be 
accepted . 


Data  Input  Commands 

The  format  of  all  data  input  commands  (except  "D" )  is: 
I  Cn..n]  t 


-terminator  -  any  non  digit  character  excluding 

address  characters.  Can  be  the  next 
command  letter.  In  the  following 
examples  is  used. 

- data  -  from  one  to  seven  digits.  The  [] 

indicate  that  this  data  is  optional; 
if  omitted  then  a  command  value  of 
zero  is  used. 


command-letter  - 


a  single  letter. 


A  -  Absolute  Position  Command 

Commands  the  axis  in  Point-to-Point  mode  to  a  specific  position 
relative  to  zero. 


Ex;  AlOOOO. 
A-1234. 


move  to  +10000  counts 
move  to  -1234  counts 


2-2 
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D  -  Acceleration,  Pecaleration  Hata 

rjsed  for  entering  data  to  define  a  controlled-path  move,  "his  is 
done  by  commanding  the  axes  to  accelerate  at  given  rate  for  a  given 
time.  Acceleration  is  in  counts  per  interrupt  units,  and  time  is  in 
.498  millisecond  units.  Each  frame  consists  of  ten  hexadecimal 
digits:  ttttiiffff  where  tttt  is  the  frame  time,  ii  is  the  intecer 

portion  nf  the— acceleration  (counts)  and  ffff  is  the  fractional 
porf^^r^  rhff  acceleration  fl/r>5536  counts).  The  data  input  is 
terminated  (at  the  end  of  a  frame)  by  either  a  non-hexadecimal 
character  or  a  frame  with  zero  time.  A  frame  with  zero  time 
indicates  the  end  of  the  contour,  at  which  the  axis  switches  to 
Point-to-Point  mode.  (See  interpolation  description  for  format  and 
a  detailed  example.) 

Ex ;  DOOOaOOaOOOOOOBFFROOOOOOOOOOOOO 
ttttiiffffttttiiffffttttiiffff 

actually:  D  0008  00  8000  accel  at  .5cts/int  for  8  interrupts, 

0008  FF  8000  decel  at  -.5  cts/int  for  8  int, 

0000  00  0000  zero  frame  time  -  end  of  contour 

E  -  Set  Early  Ready  Distance 

Sets  the  position  tolerance  in  counts  within  which  the  axis  is  said 
to  have  reached  its  commanded  position.  That  is,  when  the  axis  is 
within  "E"  counts  of  its  commanded  position,  its  "ready"  status  will 
become  true.  The  default  (power-on)  early  ready  distance  is  13 
counts  (approx  .0002"  for  EEl  encoder);  the  maximum  allowable  value 
is  255  counts. 

Ex:  E2.  set  early  ready  distance  to  2  counts 

ElOO.  set  early  ready  distance  to  100  counts 

EG.  set  no  early  ready  distance  -  axis  must  reach 

commanded  position  to  be  ready 
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F  -  Set  Maximum  Velocity 

Used  to  specify  the  maxiraum  velocity  in  Point-to-Point  mode.  The 
data  is  in  units  of  .1%  of  maximum  velocity,  that  is,  FlOOO  is 
maximum  velocity,  FlOO  is  one-tenth  of  maximum,  etc. 

Ex:  FlOOO.  set  maximum  point-to-point  vel. 

FlO.  set  1%  of  maximum  vel. 

I  -  Incremental  Position  Command 

Commands  the  axis  to  move  a  specified  distance  (increment)  from  its 
current  position.  This  is  in  contrast  to  absolute,  which  commands 
the  axis  to  a  specific  position,  instead  of  by  a  specific  distance. 
Ex:  11200.  move  the  axis  +1200  counts 

1-123.  move  the  axis  -123  counts 


O  -  Home  Offset 

This  command  is  used  to  implement  coordinate  translation,  i.e, 
re-defining  the  zero  reference  position. 


Ex:  064000. 

OO  . 

0-20000. 


set  axis  zero  to  +64000  counts  from  home  (the 

axis'  position  is  now  -64000) 

set  axis  zero  to  home  (clear  the  offset) 

set  axis  zero  to  -20000  counts  from  home  (the 

axis’  position  is  now  +20000) 
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1 


Other  Commands 

H  -  Howe 

Causes  the  axis  to  begin  the  Home/Calibrate  sequence  in  which  the 
encoder  signals  are  first  sampled  and  then  compensated  for,  after 
which  the  axis'  machine  home  position  (according  to  mechanical  or 
optical  sensors)  is  determined.  (See  standard  encoder  home 
sequence .  ) 


Ex .  H  Homes  axis 

(: 

Z  -  Zero  Set  (reset) 

Introduces  an  offset  equal  to  the  value  of  the  current  absolute 
position,  thereby  defining  that  position  as  zero.  (Independent  of 
Home  Offset  "0".) 

Ex .  Z  Zeros  axis 

Q  command  will  display  000000. 


1 


J 


I 

) 
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M  -  Select  Variable  Axis  Parameters 

Allows  the  user  to  configure  the  axis  for  particular  tables,  loads, 
etc.  The  command  requires  an  extra  letter  to  select  the  parameter 
to  be  changed. 

— tiA  -  Select  Square  Root  Deceleration 

Used  to  select  square  root  (constant)  deceleration  in  pt-to-pt 
positioning  mode.  The  command  requires  a  single  digit  from  0  to  11 
to  select  deceleration  according  to  the  following  table.  (Mote  - 
the  given  deceleration  values  are  based  upon  a  standard  EEl  encoder 
i.e.  15 .625u"/count  =  l/64000'*/ct ,  and  maximum  table  velocity  of  10 
in/ sec) 


MAO 

= 

l/512g 

3 

.7539'*/ sec/sec 

MAI 

= 

l/256g 

3 

1 . 508 "/ sec/ sec 

MA2 

S 

l/128g 

3 

3 .016''/sec/sec 

MA3 

a 

l/64g 

3 

6 .02"/sec/sec 

MA4 

= 

1/32 

g 

12.063"/sec/sec 

MAS 

= 

1/16 

g 

3 

2 4. 125 “/sec/ sec 

MA6 

s 

1/S 

g 

3 

48.25"/ sec/ sec 

MA7 

3 

1/4 

g 

= 

96.5"/sec/sec 

MAS 

3 

1/2 

g 

= 

193"/sec/ sec 

MA9 

3 

1 

g 

= 

386"/ sec/sec 

MAIO 

3 

2 

g 

3 

772"/ sec/sec 

MAll 

3 

4 

g 

3 

1544"/ sec/sec 

Ex : 

MA7 

• 

select 

1/4  g  deceleration 

MA4 

’  • 

select 

1/32  g  deceleration 
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MC  -  flA  for  lowspeed  mode .  Tach  switching  systems  only,  see  addendum 
MD  -  SET  HOME  SEARCH  DISTANCE 

Sets  half  the  number  of  cycles  searched  for  the  home  pulse.  (7he 
number  of  cycles  searched  is  twice  what  is  entered  by  MD) . 

Ex:  MD25.  For  500  line  per  inch  encoder 

MD31.  For  25  line  per  mm  encoder 

MD125.  For  2500  line  per  inch  or  100 
line  per  mm  encoder 

MF  -  DAC  Bias  Compensation 

This  number  is  added  to  the  DAC  output  when  in  the  linear  region  of 
the  point  to  point  servo.  The  purpose  of  this  is  to  insure  that  the 
output  is  enough  to  overcome  a  small  DAC  offset. 

EX.:  MF  4.  set  to  4  DAC  counts 
MF  0  set  to  0  DAC  counts 

MF  10  set  to  10  DAC  counts 

MG  -  Interpolation  Error  Gain 


MGO 

= 

Positional 

Error 

/ 

128 

MGl 

3 

Positional 

Error 

/ 

64 

MG2 

3 

Positional 

Error 

/ 

32 

MG  3 

3 

Positional 

Error 

/ 

16 

MG4 

3 

Positional 

Error 

/ 

8 

MGS 

3 

Positional 

Error 

/ 

4 

MG  6 

3 

Positional 

Error 

/ 

2 

MG  7 

3 

Positional 

Error 

/ 

1 
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— MH  -  Set  Home  Speed 

Used  to  set  the  maximum  speed  at  which  the  axis  will  search  for  the 
home  reference.  The  speed  is  programmed  in  U/A  counts,  where 
maximum  is  4095. 

Ex:  MH4095.  set  maximum  home  speed 

MH1024.  set  1/4  maximum  speed 


MI  -  Desired  Velocity  (Interpolation)  Scale  Factor 

MIO  =  X  1 
Mil  =  X  2 
MI2  =  X  3 
MI3  =  X  4 
MI4  =  X  6 
MIS  =  X  8 
MI6  »  X  12 
MI7  =  X  16 
MIS  =  X  24 
MI9  =  X  32 
MHO  =  X  48 
Mill  =  X  64 
MI12  *  X  96 
MI13  *  X  128 

DVEL  scale  factor  =  4095  (max  DAC)  /  Maximum  System  Speed  In  cts/int 
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— MR  -  Select  Linear  Deceleration  Slope 

Used  to  select  the  linear  (declining)  deceleration  slope.  It  is 
typically  used  to  match  performance  and  stability  for  a  given  axis. 
(See  Point-to-Point  servo  description) 


MRO 

— 

vel 

= 

1/16 

X 

dist 

to 

goal 

MRl 

— 

vei 

1/9 

X 

dist 

to 

goal 

MP2 

— 

vel 

= 

1/4 

X 

dist 

to 

goal 

mf3 

— 

vel 

s 

1/2 

X 

dist 

to 

goal 

MR4 

— 

vel 

s 

1 

X 

dist 

to 

goal 

MRS 

— 

vel 

= 

2 

X 

dist 

to 

goal 

MR6 

— 

vel 

= 

4 

X 

dist 

to 

goal 

Ex: 

MRO 

• 

select 

1/16  linear  slope 

MR3 

• 

select 

1/2  lineal 

■  slope 
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Non-Buff ered  (Immediate)  Commands 


The  following  commands  are  acted  upon  as  soon  as  they  are  received 
by  the  axis. 

Addressed  Commands  (require  axis  to  be  addressed) 

C  -  Output  Position 

Causes  the  current  oosition  of  the  axis  to  be  output  over  the 
communications  interface.  The  position  is  transmitted  as  six 
hexadecimal  characters  (3  bytes)  and  is  two ’ s-compl iment  binary. 


charl  char2  ; 

char3  char4  ; 

charS  char6  &  CR 

•  •  « 

•  •  4 

•  . 

least  significant  byte 

middle  byte 

most  significant  byte 


Ex .  Q  Output  position 

OOOOOF  response  -  16  counts  positive  from  0  position 
U  -  Enable  Synchronized  Ready  Mode 

Causes  the  axis  to  link  itself  to  the  Universal  Ready  signal.  This 
signal  is  the  logical  "AND"  of  all  linked  axes'  ready  states;  it 
indicates  that  all  linked  axes  have  completed  command  execution. 
1/hen  linked  in  this  manner,  the  axes  begin  each  new  command  at  the 
same  tine,  allowing  for  synchronized  system  control. 

Ex .  U  Enables  synchronized  ready  mode. 

V  -  Disable  Synchronized  Ready  ■'lode 

Disconnects  the  axis  from  the  Universal  Ready  Signal. 

Ex .  V  Disables  synchronized  ready  node. 
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COMMAND  SUMMARY 


default  data  immed  addr 


A  Absolute  Position  Command . Asnnnnnnn.. 

D  Interpolation  Acceleration  Data.  Dhhhhhhhhhh 

E  Set  Early  Ready  Distance .  Ennn . 

F  Set  Maximum  Velocity .  Fnnnn . 

G  Acceleration  Servo  Mode . G . 


H  Home .  H. 


I  Incremental  Position  Command....  Isnnnnnnn 


J  Servo  Off 


M  Select  variable  axis  parameters: 

JIA  Select  pt-pt  deceleration..  MAn . 

MB  Set  Velocity  Offset . MBsnnn.... 

MC  MA  for  low  speed  mode . 

Tach  switching  systems  only.MCn . 

MD  Set  Home  Pulse  Search  Dist.  MDnn . 

MF  Set  DAC  Bias  Compensation..  MFn . 

MG  Interpolation  Error  Gain...  MGn . 

MU  Set  Home  Speed .  MHnnnn.... 

MI  Interp.Des.  Vel.  Scale  Fac .  Mln . 

ML  Set  Lin  (usually  2X  Predis)  MLnnnnn... 
MP  Set  Predis .  MPnnnnn... 


MR  Select  Linear  Slope . MRn........ 

O  Set  Home  Offset .  Osnnnnnnn 


P  Point- to-Point  Servo  Mode .  P, 

Q  Output  Position .  Q, 


R  Servo  Off. 


U  Enable  Universal  Ready  Mode . IJ. 

V  Disable  Universal  Ready  Mode....  V, 


W  Output  Status 


X  Abort  Command  Execution . X. 

Y  Abort  Command  Execution .  Y, 


Z  Set  Zero. 


+50  cycles 
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"data"  indicates  that  command  requires  numeric  data 
"immed"  indicates  that  command  is  executed  as  soon  as  it's  received 
"addr"  indicates  that  axis  must  be  addressed  for  command  to  be 
executed 

n  =  decimal  digit  0-9 

h  =  hexadecimal  digit  0-9,  A-F 

s  =  sign  (  +  ,-)’  if  omitted,  +  assumed 

NOTE:  For  the  data  input  commands,  the  number  of  digits  shown  is 

the  maximum  number  of  digits  allowed  -  any  smaller  number 
of  digits  is  acceptable;  only  significant  digits  are 
necessary. 


3-2 


ZUPT  W/2  BASES  (M2) 


7.30441  7.15834  0.146061 

7.1865  7.15834  0.0281605 

7.18247  7.15834  0.0241231 

7.15927  7.15833  0.000940704 

Mean  Error  =  0.04982  (inches)  STD  =  0.05653  (inches) 

Max  Error  =  0.1461  (inches) 

Sampling  rate  =  300.03  (Hz) 

Filter  bandwidth  =  40  (Hz) 

A-to-D  Range  =  1  (Gs) 

Integration  method  =  1 

(0-Simp  1-Trap  2-Adam) 

Number  of  runs  =  4 


ZUPT  W/2  BASES  (M2) 


7.20275 

7.15834 

0.044411 

7.13201 

7.15834 

-0.0263327 

7.15324 

7.15834 

-0.0051064 

7.11669 

7 . 15834 

-0.0416573 

7.14982 

7.15834 

-0.00852089 

7.16546 

7.15834 

0.00711192 

7 . 16868 

7.15834 

0.010335 

7.16711 

7 . 15834 

0.00876731 

7.20367 

7 . 15833 

0.0453468 

7.15949 

7.15834 

0.00114539 

7.12438 

7.15834 

-0.0339601 

7.12775 

7.15834 

-0.0305962 

7.23076 

7.15834 

0.0724123 

7.1694 

7.15834 

0.0110526 

7.14557 

7.15834 

-0.0127723 

7.17002 

7.15834 

0.0116749 

7.16657 

7.15834 

0.00822315 

7.17329 

7.15834 

0.0149415 

7.11822 

7 . 15834 

-0.0401271 

7.15417 

7.15834 

-0.00416887 

7.12214 

7.15834 

-0.0361999 

7.29125 

7.15834 

0.132905 

7.10728 

7.15834 

-0.051064 

7.15111 

7.15834 

-0.00723693 

7.11567 

7.15834 

-0.0426769 

7.08974 

7.15834 

-0.0686072 

7.19755 

7.15834 

0.0392108 

7.12916 

7.15836 

-0.0291945 

7.19461 

7.15834 

0.0362638 

7.25577 

7.15834 

0.097428 

7.09025 

7.15834 

-0.0680972 

7.20021 

7.15834 

0.0418621 

7.16298 

7.15834 

0.00463132 

7.14292 

7.15834 

-0.0154208 

7.14574 

7.15834 

-0.0126082 

7.13279 

7.15834 

-0.0255554 

7.15601 

7.15833 

-0.00232236 

7.15576 

7.15834 

-0.00257956 

7.19948 

7.15834 

0.0411383 

7.15835 

7.15834 

2.92266e-006 

*7  1  A 

. n  AC  A  on AC 

Y . Z40by 

Y  .  10bb4 

0.0yU3466 

7.12619 

7.15834 

-0.0321568 

7.08353 

7.15836 

-0.0748272 

7.13555 

7.15834 

-0.0227911 

7.21819 

7.15834 

0.0598437 

7.13713 

7.15834 

-0.0212158 

7.11653 

7.15834 

-0.0418092 

7.15717 

7.15834 

-0-00117053 

6.57505 

7.15834 

-0.583294 

Mean  Error  =  -0.01235  (inches)  STD  =  0.09205  (inches) 

Max  Error  =  -0.5833  (inches) 

Sampling  rate  =  300.03  (Hz) 

Filter  bandwidth  =  40  (Hz) 

A-to-D  Range  =  1  (Gs) 

Integration  method  =  1 
(O-Simp  1-Trap 
N\iinber  of  runs  =  50 


2-Adam) 


ZUPT  W/2  BASES  (M2) 


7.44339  7 
7.29352  7 
7.22559  7 
7.17013  7 


15834  0.285044 

15833  0.135187 

15833  0.0672611 

15834  0.0117896 


Mean  Error  =  0.1248  (inches)  STD  =  0.1023  (inches) 

Max  Error  =  0.285  (inches) 

Sampling  rate  =  200  (Hz) 

Filter  bandwidth  =  40  (Hz) 

A-to-D  Rajige  =  1  (Gs) 

Integration  method  =  1 

(0-Simp  1-Trap  2-Adam) 

N^amber  of  runs  =  4 


ZUPT  ONLY 

10.4659 

10.7375 

10.4443 

10.7375 

10.4492 

10.7375 

10.4836 

10.7375 

10.3753 

10.7375 

10,5135 

10.7375 

10.4561 

10.7375 

10.4361 

10.7375 

10.5301 

10.7375 

10.488 

10.7375 

10.4666 

10.7375 

10.3974 

10.7375 

10.5306 

10.7375 

10.4628 

10.7375 

10.4771 

10.7375 

10.3546 

10.7375 

10.4174 

10.7375 

10.4964 

10.7375 

10.5155 

10.7375 

10.4249 

10.7375 

10.4129 

10.7375 

10.4964 

10.7375 

10.5076 

10.7375 

10.4869 

10.7375 

10.4514 

10.7375 

10.4267 

10.7375 

10.4121 

10.7375 

10.4903 

10.7375 

10.3975 

10.7375 

10.4454 

10.7375 

10.5413 

10.7375 

10.4849 

10.7375 

10.436 

10.7375 

10.3258 

10.7375 

10.5613 

10.7375 

10.4539 

10.7375 

10.5232 

10.7375 

10.4435 

10.7375 

10.5209 

10.7375 

10.4358 

10.7375 

-0.271614 
-0.293167 
-0.288347 
-0.253901 
-0.3622 
-0.224022 
-0.28145 
-0.301446 
-0.207372 
-0.249539 
-0.27089 
-0.340082 
-0.206871 
-0.274736 
-0.260416 
-0.382905 
-0.320126 
-0,241153 
-0.221975 
-0.312634 
-0.324588 
-0.241136 
-0.229934 
-0 . 250652 

-0 . 286082  o"' 

-0.310801  • 

-0 . 325385  ' 

-0.247166 
-0.339971 
-0.292108 
-0.196196 
-0.25259 
-0.301544 
-0.411754 
-0.176204 
-0.283599 
-0.214327 
-0.293985 
-0.216621 
-0.301699 


V./  •  <  w  < 


10 

10.4113  10 

10.424  10 

10.4419  10 

10.516  10 

10.3946  10 

10.4395  10 

10.4485  10 


7375 

-0.29853 

7375 

-0.326196 

7375 

-0.313559 

7375 

-0.295585 

7375 

-0.221528 

7375 

-0.34287 

7375 

-0.297976 

7375 

-0.289051 

Mean  Error  =  -0.2806  (inches)  STD 

Max  Error  =  -0.4118  (inches) 

Sampling  rate  =  200  (Hz) 

Filter  bandwidth  =  40  (Hz) 

A-to-D  Range  =  1  (Gs) 

Integration  method  =  l 

(0-Simp  1-Trap  2-Adam) 

Number  of  runs  =  50 


0.04909  (inches) 


X'sJ  •  WWW 


10.6821 

10.7375 

-0.0553822 

10.611 

10.7375 

-0.126509 

10.6344 

10.7375 

-0.103088 

10.6443 

10.7375 

-0.0931978 

10.6966 

10.7375 

-0.0409445 

10.6544 

10.7375 

-0.0831523 

10.7071 

10.7375 

-0.0303822 

10.644 

10.7375 

-0.0935399 

10.6869 

10.7375 

-0.C506013 

Mean  Error  =  -0.3825  (inches)  STD  =  1.617  (inches) 

Max  Error  =  -9.25535  (inches) 

Sampling  rate  =  200  (Hz) 

Filter  bandwidth  =  40  (Hz) 

A-to-D  Range  =  1  (Gs) 

Integration  method  =  1 

(0-Simp  1-Trap  2-Adam) 

Number  of  runs  =  50 


ZUPT  W/2  BASES  (M2) 


7.43025 

7.15834 

0.271904 

7.39292 

7.15834 

0.234581 

7.21671 

7.15834 

0.0583694 

7.20442 

7.15834 

0.0460733 

Mean  Error  =  0. 

1527  (inches) 

STD  = 

Max  Error  =  0.2719  (inches) 

Sampling  rate  =  200  (Hz) 

Filter  bandwidth  =  40 

(Hz) 

A-to-D  Range  =  1  (Gs) 
Integration  method  = 

1 

(0-Simp  1-Trap 

2-AdaLm ) 

Number  of  runs  =  4 

3.7217 

SINGLE 

3.57917 

0.142527 

3.74455 

3.57917 

0.165374 

3.67074 

3.57917 

0.0915699 

3.76825 

3.57917 

0.189078 

3.71378 

3.57917 

0.134606 

3.79898 

3.57917 

0.219806 

3.76927 

3.57916 

0.190115 

3.7909 

3.57917 

0.211731 

3.81156 

3.57917 

0.232383 

3.77446 

3.57917 

0.195283 

3.84755 

3.57917 

0.268377 

3.68388 

3.57917 

0.104713 

3.83674 

3.57917 

0.257572 

3.75973 

3.5791” 

0.180559 

3.84719 

3.57917 

0.268018 

3.71489 

3.57917 

0.135715 

3.77763 

3.57917 

0.196457 

3.71851 

3.57917 

0.139334 

3.6254 

3.57916 

0.0462468 

3.81362 

3.57917 

0.234453 

3.74733 

3.57917 

0.168155 

3.7395 

3.57917 

0.160329 

3.70978 

3.57917 

0.13061 

3.68336 

3.57917 

0.104189 

3.75655 

3.57917 

0.177379 

3.71036 

3.57916 

0.131202 

3.67549 

3.57916 

0.0963378 

3.63095 

3.57917 

0.0517735 

3.68743 

3.57917 

0.108262 

3.72398 

3.57916 

0.144821 

3.70681 

3.57916 

0.127657 

3.74794 

3.57917 

0.168766 

3.71601 

3.57919 

0.136825 

3.6639 

3.57917 

0.0847326 

3.76259 

3.57937 

0.183421 

3.68004 

3.57916 

0.100881 

3.70031 

3.57917 

0.121137 

3.72125 

3.57916 

0.142093 

3.71998 

3.57916 

0.14082 

3.66858 

3.57917 

0.0894032 

3.60977  3 

3.67302  3 

3.77422  3 

3.72409  3 

3.70178  3 

3.76619  3 

3.7526  3 

3.75786  3 

3.65471  3 


57919 

0.0305816 

57916 

0.0938641 

57917 

0.195046 

57917 

0.144922 

57916 

0.122626 

57917 

0.187021 

57917 

0.17343 

57917 

0.178684 

57917 

0.0755369 

Mean  Error  =  0.1497  (inches)  STD  =  0.05474  (inches) 

Max  Error  =  0.2684  (inches) 

Sampling  rate  =  200  (Hz) 

Filter  bandwidth  =  40  (Hz) 

A-to-D  Range  =1  (Gs) 

Integration  method  =  1 

(0-Simp  1-Trap  2-Adam) 

Nxamber  of  runs  =  50 


ZUPT  W/2  BASES  (M2) 

7.71103  7.15834  0.552688 

7.40671  7.15834  0.248369 

Mean  Error  =  0.4005  (inches)  STD  =  0.1522  (inches) 

Max  Error  =  0.5527  (inches) 

Sampling  rate  =  200  (Hz) 

Filter  bandwidth  =  40  (Hz) 

A-to-D  Range  =  1  (Gs) 

Integration  method  =  1 

(0-Simp  1-Trap  2-Adam) 

Number  of  runs  =  2 


2UPT  W/2  BASES  (M2) 


7.33207 

7.15834 

0.173723 

7.20969 

7.15834 

0.0513454 

7.19432 

7.15834 

0.0359726 

7.20165 

7.15834 

0.0433022 

7.0976 

7.15834 

-0.0607487 

7.18628 

7.15834 

0.027941 

7.12231 

7.15834 

-0.0360384 

7.14922 

7.15834 

-0.00912419 

7.2457 

7.15834 

0.0873563 

7.09991 

7.15834 

-0.0584323 

7.13646 

7.15834 

-0.0218851 

7.36029 

7.15834 

0.20195 

7.08902 

7.15833 

-0.0693051 

7.08859 

7.15836 

-0.0697731 

7.08235 

7.15834 

-0.0759961 

8.48598 

7.15R34 

1.32764 

6.61151 

7.15834 

-0.546837 

6.73718 

7.15834 

-0.421167 

7.07975 

7.15836 

-0.0786095 

7.14799 

7.15834 

-0.010349 

7.21924 

7.15834 

0.0608971 

7.0986 

7.15834 

-0.059746 

7.08265 

7.15834 

-0.0756949 

7.12416 

7.15834 

-0.034186 

7.24217 

7.15834 

0.0838257 

7.22167 

7.15834 

0.063328 

7.10807 

7.15834 

-0.0502786 

7.14702 

7.15834 

-0.0113227 

7.17431 

7.15834 

0.015971 

7.10684 

7.15834 

-0.051503 

7.15627 

7.15834 

-0.00207368 

7.13143 

7.15834 

-0.0269168 

7.13841 

7.15834 

-0.0199348 

7.18337 

7.15834 

0.0250295 

7.15283 

7.15834 

-0.00551456 

7.17664 

7.15834 

0.0182948 

7.20265 

7.15834 

0.0443014 

7.11525 

7.15834 

-0.043093 

7.15147 

7.15834 

-0.00687234 

7.17072 

7.15834 

0.0123791 

7.17711 

7.15834 

0-0187615 

7.19479 

7.15834 

0.0364444 

t  OC  3 

t  C  3  O 

7.13856  7.15834  -0.0197797 

7.12869  7.15834  -0.0296585 

7.19144  7.15834  0.0330956 

7.13001  7.15834  -0.0283296 

7.16615  7.15833  0.00781981 

7.15237  7.15834  -0.005978 

Mean  Error  =  0.007973  (inches)  STD  =  0.2189  (inches) 

Max  Error  =  1.328  (inches) 

Sampling  rate  =  200  (Hz) 

Filter  bandwidth  =  40  (Hz) 

A-to-D  Range  =  1  (Gs) 

Integration  method  =  1 

(0-Simp  1-Trap  2- Adam) 

N\amber  of  r\ins  =  50 


f 


ZUPT  W/2  BASES  (M2) 


7.45049 

7.15834 

7.28482 

7.15834 

7.21856 

7.15834 

7.15354 

7.15834 

Meain  Error  = 

0.1185  (inches 

Max  Error  = 

0.2921  (inches) 

Sampling  rate  = 

300.03  (Hz) 

Filter  bandwidth  =  40  (Hz) 

A-to-D  Range  = 

1  ( Gs ) 

Integration  met 

hod  =  1 

( 0-Simp 

1-Trap  2-Adam) 

Number  of  runs 

=  4 

SINGLE 

3.55978 

3.57917 

3.54229 

3.57917 

3.54694 

3.57917 

3.63482 

3.57917 

3.63281 

3.57917 

3.62732 

3.57916 

3.65493 

3.57917 

3.64363 

3.57917 

3.58617 

3.57917 

3.65271 

3.57917 

3.64166 

3.57917 

3.57481 

3.57916 

3.63181 

3.57917 

3.6761 

3.57917 

3.69462 

3.57916 

3.63971 

3.57917 

3.51247 

3.57917 

3.63727 

3.57917 

3.60522 

3.57917 

3.54944 

3.57917 

3.54651 

3.57917 

3.60893 

3.57917 

3.64881 

3.57917 

3.63893 

3.57917 

3.62365 

3.57917 

3.63384 

3.57917 

3.67087 

3.57917 

3.59821 

3.57917 

3.68936 

3.57917 

3.70367 

3.57917 

3.09755 

3.57917 

3.68552 

3.57917 

3.65328 

3.57917 

3.65864 

3.57916 

3.73494 

3.57917 

3.71158 

3.57916 

3.61414 

3.57917 

3.67858 

3.57917 

3.64598 

3.57917 

3.69938 

3.57917 

9  API  PI 

'3  S701,:; 

0.292143 

0.126476 

0.0602202 

-0.00480726 

STD  =  0.1105  (inches) 


-0.01939 

-0.0368816 

-0.0322323 

0.0556449 

0.0536336 

0.0481628 

0.0757594 

0.0644545 

0.00700136 

0.0735389 

0.0624923 

-0.00434921 

0.0526363 

0.0969242 

0.11546 

0.0605346 

-0.0667012 

0.0580935 

0.0260435 

-0.0297321 

-0.0326585 

0.0297585 

0.0696343 

0.0597571 

0.044475 

0.054666 

0.0916981 

0.0190411 

0.11019 

0.124498 

0.118376 

0.106345  v” 

0.0741094 
0.0794848 
0.155771 
0.132425 
0.0349671 
0.0994099 
0.0668099 
0.120206 
n 


3.76603 

3.57916 

0.18687 

3.72948 

3.57917 

0.150306 

3.69942 

3.57916 

0.120266 

3.57036 

3.57919 

-0.00883179 

3.69021 

3.57917 

0.111038 

3.61883 

3.57917 

0.0396579 

3.64885 

3.57917 

0.069681 

3.61286 

3.57917 

0.0336911 

3.61364 

3.57917 

0.0344713 

Mean  Error  =  0.0612  (inches)  STD  =  0.05404 

Max  Error  =  0.1869  (inches) 

Sampling  rate  =  300.03  (Hz) 

Filter  bandwidth  =  40  (Hz) 

A-to-D  Range  =  1  (Gs) 

Integration  method  =  1 

(0-Simp  1-Trap  2-Adam) 

Number  of  runs  =  50 


( inches ) 


